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DESCRIPTION 
GAIT PRODUCING DEVICE FOR MOVING ROBOT 

Technical Field 

The present invention relates to a device for 
producing desired gaits of a bipedal moving robot or the 
like . 

Background Art 

As a technology for generating desired gaits of a 
moving robot, such as a bipedal moving robot, there has 
been known a technology in which an error of a floor 
reaction force moment about a desired ZMP or an error of an 
actual ZMP from the desired ZMP is observed and a gait is 
corrected to reduce the error, as disclosed in, for example, 
Japanese Patent No. 3443077 (patent document 1) or in 
"Realtime walking stabilization control of a biped humanoid 
robot - Verifying the validity of a walking control module 
in HRP - "/3P14/The 18th Annual Conference of the Robotics 
Society of Japan (non-patent document 1) . 

However, these technologies do not consider an 
error of a translational floor reaction force; therefore, 
if a gait is to be generated for a robot to walk on a road 
surface having a low friction coefficient or if a gait 
having a period during which a translational floor reaction 
. force vertical component becomes zero or substantially zero, 
such as in running, is to be generated, it will be 
difficult to generate a gait that restrains the robot from 
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slipping. 

Thus, technologies disclosed in, for example, 
Japanese Unexamined Patent Application Publication No. 
2002-326173 (patent document 2) and PCT international 
5 publication WO/03/057427/A1 (patent document 3) have been 
proposed by the present applicant. According to the 
technologies disclosed in these patent documents 3 and 4, 
an instantaneous desired gait composed of an instantaneous 
value of a desired motion (instantaneous desired motion) of 

10 a robot and an instantaneous value of a desired floor 

reaction force (instantaneous desired floor reaction force) 
is sequentially created using a first dynamic model 
(simplified model), which represents a relationship between 
motions of the robot (the positions and postures of 

15 individual portions) and floor reaction forces, such that a 
dynamic balance condition (a condition, such as the one in 
that a translational force component of a floor reaction 
force takes a desired value or a floor reaction force 
moment about a certain point takes a desired value) on the 

20 first dynamic model is satisfied. Then, the instantaneous 
desired gait is input to a second dynamic model (full 
model) wherein a part of the instantaneous desired motion 
(desired body position/posture, a desired moment about a 
desired ZMP, or the like) is corrected so as to generate a 

25 final instantaneous desired gait in a time series manner. 

According to the technology, using a model having 
high linearity as the first dynamic model (simplified 
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model) makes it possible to efficiently and promptly create 
a gait that enables a robot to continue a stable motion, 
and using a model having relatively high dynamic accuracy 
as a second dynamic model (full model) makes it possible to 
5 bring the dynamic accuracy between a motion of a finally 
generated gait and a floor reaction force closer to the 
dynamics of an actual robot. 

Meantime, according to the technologies disclosed 
in the aforesaid patent documents 2 and 3, the correction 

10 of an instantaneous desired motion (the correction of body 
position/posture) using the second dynamic model at 
arbitrary time t is made by using a past value of a moment 
about a desired ZMP (a correction amount of a moment about 
a desired ZMP) output from the second dynamic model. More 

15 specifically, according to the technologies disclosed in 

patent documents 2 and 3, a past value of a moment about a 
desired ZMP output from the second dynamic model is 
considered to indicate the dynamic error of an 
instantaneous value of a gait newly created using the first 

20 dynamic model and then the instantaneous value of a new 
gait is corrected on the basis of the past value of the 
moment. In other words, there is a temporal difference 
between the motion of a gait that has been finally 
corrected using the second dynamic model and. a floor 

25 reaction force (the moment about a desired ZMP) that is 
referred to when making the correction. 

However, the dynamic error of a gait created using 
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the first dynamic model changes, depending on a gait motion 
pattern, so that the past value of the moment about the 
desired ZMP output from the second dynamic model does not 
necessarily indicate a dynamic error of an instantaneous 
5 value of a new gait created using the first dynamic model. 

Further, the second dynamic model has high nonlinearity , so 
that a motion of a gait created using it tends to diverge. 
Hence, according to the technologies disclosed in patent 
documents 2 and 3, it has been necessary to correct a 

10 desired ZMP trajectory or to generate a floor reaction 
force moment about a desired ZMP so as to restrain a 
desired motion trajectory of a robot from deviating from a 
motion trajectory of a gait created using the first dynamic 
model. And in this case, there have been occasions where a 

15 correction amount of a desired ZMP trajectory or a floor 
reaction force moment about a desired ZMP becomes 
relatively large, which has sometimes led to a difficulty 
in maintaining a large stability margin. Conversely, if 
the permissible range of a correction amount of a desired 

20 ZMP trajectory or a floor reaction force moment about a 
desired ZMP is set to be narrow in order to maintain a 
large stability margin, then the danger of the divergence 
of a gait has inconveniently increased. 

The present invention has been made with a view 

25 toward the aforesaid background, and it is an object 

thereof to provide a gait producing device for a moving 
robot that is capable of efficiently generating a gait that 
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permits prevention of a slippage of a robot and also 
capable of successfully securing dynamic accuracy between a 
motion of the gait and a floor reaction force while 
ensuring temporal coordination therebetween. 

5 

Disclosure of Invention 

To fulfill the aforesaid object, according to a 
first invention of a gait producing device for a moving 
robot in accordance with the present invention, there is 

10 provided a gait producing device that sets a desired value 
of a floor reaction force moment horizontal component 
generated by a motion of a moving robot and a permissible 
range of a translational floor reaction force horizontal 
component and generates a desired gait that includes at 

15 least a desired motion of a moving robot such that the 

desired value of the floor reaction force moment horizontal 
component and the permissible range of the translational 
floor reaction force horizontal component are satisfied, 
comprising : 

20 a provisional motion creating means that uses a 

predetermined first dynamic model of the moving robot to 
create a provisional motion, which is a provisional value 
of the desired motion, such that the desired value of the 
floor reaction force moment horizontal component and the 

25 permissible range of the translational floor reaction force 
horizontal component are satisfied on the first dynamic 
model, and a provisional motion correcting means that 
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corrects the created provisional motion by using the first 
dynamic model and a predetermined second dynamic model 
having a dynamic accuracy that is higher than that of the 
first dynamic model and obtains the corrected motion as the 
5 desired motion, 

wherein provided that, in relation to arbitrary 
time t of the provisional motion, a difference between the 
floor reaction force moment horizontal component M2(t) 
generated at the time t on the second dynamic model by the 

10 provisional motion and the floor reaction force moment 

horizontal component Ml(t) generated at the time t on the 
first dynamic model by the provisional motion (M2 ( t ) -Ml ( t ) ) 
is defined as a floor reaction force moment horizontal 
component error Merr(t), and a difference between the 

15 translational floor reaction force horizontal component 

F2(t) generated at the time t on the second dynamic model 
by the provisional motion and the translational force 
horizontal component Fl(t) generated at the time t on the 
first dynamic model by the provisional motion (F2 ( t ) -Fl ( t ) ) 

20 is defined as a translational floor reaction force 
horizontal component error Ferr(t), then 

the provisional motion correcting means corrects 
an instantaneous value of the provisional motion at the 
time t such that a value obtained by adding either the 

25 floor reaction force moment horizontal component error 

Merr(t) or a first floor reaction force correction amount 
determined on the basis of at least the floor reaction 
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force moment horizontal component error Merr(t) to the 
floor reaction force moment horizontal component generated 
at the time t on the first dynamic model by a motion 
obtained after correcting the provisional motion agrees 
5 with the desired value at the time t, and a value obtained 
by adding either the translational floor reaction force 
horizontal component error Ferr(t) or a second floor 
reaction force correction amount determined on the basis of 
at least the translational floor reaction force horizontal 
10 component error Ferr(t) to the translational floor reaction 
force horizontal component generated at the time t on the 
first dynamic model by a motion obtained after correcting 
the provisional motion satisfies the permissible range at 
the time t. 

15 Incidentally, in the present invention, the 

dynamic accuracy of the second dynamic model being higher 
than that of the first dynamic model means that a floor 
reaction force generated on the second dynamic model by an 
arbitrary motion of a robot is closer to an actual floor 

20 reaction force (real floor reaction force) acting on the 

robot when the actual robot performs the motion on a floor 
assumed for the motion than a floor reaction force 
generated on the first dynamic model by the motion is. 
This is not limited to the first invention, but it will 

25 apply to any one of second to fourth inventions to be 
discussed hereinafter. 

Further, a desired value of a floor reaction force 
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moment horizontal component on an arbitrary dynamic model 
being satisfied on an arbitrary motion of a robot means 
that a floor reaction force moment horizontal component (a 
moment horizontal component in a floor reaction force 
5 wherein dynamics of the dynamic model holds with respect to 
the motion) generated on the dynamic model about a certain 
set point of action (e.g., a desired ZMP or a total center- 
of-gravity point of the robot) by the motion agrees or 
substantially agrees with a desired value. This is not 

10 limited to the first invention, but it will apply also to 
the second invention to be discussed hereinafter. 
Furthermore, a permissible range of a translational floor 
reaction force horizontal component on an arbitrary dynamic 
model being satisfied on an arbitrary motion of a robot 

15 means that a translational floor reaction force horizontal 
component (a translational force horizontal component in a 
floor reaction force wherein dynamics of the dynamic model 
holds with respect to the motion) generated on the dynamic 
model by the motion falls within the permissible range. 

20 This is not limited to the first invention, but it will 
apply also to the second to the fourth inventions to be 
discussed hereinafter . 

According to the first invention, the provisional 
motion is temporarily generated by the provisional motion 

25 creating means by using the first dynamic model such that 
the desired value of the floor reaction force moment and 
the permissible range of the translational floor reaction 
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force horizontal component are satisfied. Then, the 
provisional motion is corrected by the provisional motion 
correcting means and the corrected motion is obtained as a 
desired motion. 

5 At this time, the provisional motion correcting 

means corrects the instantaneous value of a provisional 
motion at time t such that a value obtained by adding 
either the floor reaction force moment horizontal component 
error Merr(t) or a first floor reaction force correction 

10 amount determined on the basis of at least the floor 

reaction force moment horizontal component error Merr(t) to 
the floor reaction force moment horizontal component 
generated at the time t on the first dynamic model by a 
motion obtained after correcting the provisional motion 

15 agrees with the desired value at the time t. At the same 
time, the provisional motion correcting means corrects an 
instantaneous value of a provisional motion at the time t 
such that a value obtained by adding either the 
translational floor reaction force horizontal component 

20 error Ferr(t) or a second floor reaction force correction 
amount determined on. the basis of at least the 
translational floor reaction force horizontal component 
error Ferr(t) to the translational floor reaction force 
horizontal component generated at the time t on the first 

25 dynamic model by a motion obtained after correcting the 

provisional motion satisfies the permissible range at the 
time t. In this case, the floor reaction force moment 
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horizontal component error Merr(t) at time t is the 
difference between a floor reaction force moment horizontal 
component M2 (t) generated at the time t on the second 
dynamic model by a provisional motion and a floor reaction 
5 force moment horizontal component Ml(t) generated at the 

time t on the first dynamic model by the provisional motion, 
so that it means an error of a floor reaction force moment 
horizontal component on the first dynamic model 
corresponding to a provisional motion at the time t. 

10 Similarly, the translational floor reaction force 

horizontal component error Ferr(t) at time t is the 
difference between a translational floor reaction force 
horizontal component F2(t) generated at the time t on the 
second dynamic model by a provisional motion and a 

15 translational floor reaction force horizontal component 

Fl(t) generated at the time t on the first dynamic model by 
the provisional motion, so that it means an error of a 
translational floor reaction force horizontal component on 
the first dynamic model corresponding to a provisional 

20 motion at the time t. 

Thus, a desired motion obtained by correcting a 
provisional motion as described above is temporally 
coordinated with a floor reaction force. 

Further, a floor reaction force moment horizontal 

25 component (referred to as Ml' (t) here) obtained by adding 
the floor reaction force moment horizontal component error 
Merr(t) or the first floor reaction force correction amount 
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based on the Merr(t) to a floor reaction force moment 
horizontal component generated on a first dynamic model by 
the desired motion approximates a floor reaction force 
moment horizontal component generated on a second dynamic 
5 model by the desired motion, so that Ml' (t) has high 
dynamic accuracy on a desired motion. Similarly, a 
translational floor reaction force horizontal component 
(referred to as Fl' (t) here) obtained by adding the 
translational floor reaction force horizontal component 

10 error Ferr(t) or the second floor reaction force correction 
amount based on the Ferr(t) to a translational floor 
reaction force horizontal component generated on a first 
dynamic model by the desired motion approximates a 
translational floor reaction force horizontal component 

15 generated on a second dynamic model by the desired motion, 
so that Fl' (t) also has high dynamic accuracy on a desired 
motion. Therefore, determining a desired motion 
(correcting a provisional motion) such that these Ml' (t) 
and Fl' (t) satisfy the desired value and the permissible 

20 range, respectively, makes it possible to generate a 

desired gait having high dynamic accuracy while properly 
satisfying the desired value and the permissible range. 

Further, the aforesaid provisional motion and the 
correction of this provisional motion (the generation of a 

25 desired motion) are performed using the first dynamic model 
(this usually has higher linearity than that of the second 
dynamic model) , and the second dynamic model is used simply 
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to determine a floor reaction force from a provisional 
motion. This makes it possible to efficiently and promptly 
carry out the processing for generating a provisional 
motion and a desired motion and the processing for 
5 calculating a floor reaction force with respect to the 
provisional motion . 

Thus, according to the first invention, it is 
possible to efficiently generate a gait capable of 
preventing a robot from slipping and also to successfully 

10 secure dynamic accuracy between a motion of the gait and a 
floor reaction force while ensuring temporal coordination 
therebetween at the same time. 

Further, to fulfill the aforesaid object, 
according to a second invention of a gait producing device 

15 for a moving robot in accordance with the present invention, 
there is provided a gait producing device that sets a 
desired value of a floor reaction force moment horizontal 
component generated by a motion of a moving robot and a 
permissible range of a translational floor reaction force 

20 horizontal component and generates a desired gait that 

includes at least a desired motion of a moving robot such 
that the desired value of the floor reaction force moment 
horizontal component and the permissible range of the 
translational floor reaction force horizontal component are 

25 satisfied, comprising: 

a provisional motion creating means that uses a 
predetermined first dynamic model of the moving robot to 
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create a provisional motion , which is a provisional value 
of the desired motion, such that the desired value of the 
floor reaction force moment horizontal component and the 
permissible range of the translational floor reaction force 
5 horizontal component are satisfied on the first dynamic 
model, and a provisional motion correcting means that 
corrects the created provisional motion by using the first 
dynamic model and a predetermined second dynamic model 
having a dynamic accuracy that is higher than that of the 

10 first dynamic model and obtains the corrected motion as the 
desired motion, 

wherein provided that, relative to arbitrary time 
t of the provisional motion, a difference between the floor 
reaction force moment horizontal component M2(t) generated 

15 at the time t on the second dynamic model by the 

provisional motion and the desired value MT(t) of the floor 
reaction force moment horizontal component at the time t 
(M2 ( t ) -MT( t ) ) is defined as a floor reaction force moment 
horizontal component error Merr(t), and a difference 

20 between the translational floor reaction force horizontal 
component F2(t) generated at the time t on the second 
dynamic model by the provisional motion and the 
translational force horizontal component Fl(t) generated at 
the time t on the first dynamic model by the provisional 

25 motion (F2( t ) -Fl(t ) ) is defined as a translational floor 
reaction force horizontal component error Ferr(t), then 
the provisional motion correcting means corrects 
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an instantaneous value of the provisional motion at the 
time t such that a value obtained by adding either the 
floor reaction force moment horizontal component error 
Merr(t) or a first floor reaction force correction amount 
5 determined on the basis of at least the floor reaction 
force moment horizontal component error Merr(t) to the 
floor reaction force moment horizontal component generated 
at the time t on the first dynamic model by a motion 
obtained after correcting the provisional motion agrees 

10 with the desired value at the time t, and a value obtained 
by adding either the translational floor reaction force 
horizontal component error Ferr(t) or a second floor 
reaction force correction amount determined on the basis of 
at least the translational floor reaction force horizontal 

15 component error Ferr(t) to the translational floor reaction 
force horizontal component generated at the time t on the 
first dynamic model by a motion obtained after correcting 
the provisional motion satisfies the permissible range at 
the time t. 

20 The second invention differs from the first 

invention only in the aspect that the difference between 
the floor reaction force moment horizontal component M2 (t) 
generated at the time t on the second dynamic model by the 
provisional motion and the desired value MT(t) of the floor 

25 reaction force moment horizontal component at the time t 

(M2 (t ) -MT (t ) ) is defined as the floor reaction force moment 
horizontal component error Merr(t). In other words, the 
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provisional motion is generated such that a desired value 
of the floor reaction force moment horizontal component is 
satisfied, so that the provisional motion causes a floor 
reaction force moment horizontal component generated on the 
5 first dynamic model (a floor reaction force moment 

horizontal component calculated on the first dynamic model 
from the provisional motion) to agree or substantially 
agree with the desired value. Hence, the second invention 
has been constructed as described above. 

10 According to the second invention, a desired 

motion obtained by correcting a provisional motion ensures 
temporal coordination between itself and a floor reaction 
force, as with the first invention. 

Moreover, as with the first invention, a desired 

15 gait with high dynamic accuracy can be generated while 

properly satisfying a desired value and a permissible range 
at the same time by determining a desired motion 
(correcting a provisional motion) such that the floor 
reaction force moment horizontal component Ml' (t) obtained 

20 by adding either the floor reaction force moment horizontal 
component error Merr(t) or the first floor reaction force 
correction amount based on the Merr(t) to a floor reaction 
force moment horizontal component generated on the first 
dynamic model by the desired motion satisfies the desired 

25 value and also the translational floor reaction force 

horizontal component Fl' (t) obtained by adding either the 
translational floor reaction force horizontal component 
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error Ferr(t) or the second floor reaction force correction 
amount based on the Ferr(t) to a translational floor 
reaction force horizontal component generated on the first 
dynamic model by the desired motion satisfies the 
5 permissible range. 

Further, as with the first invention, the 
aforesaid provisional motion and the correction of this 
provisional motion (the generation of a desired motion) are 
performed using the first dynamic model, and the second 

10 dynamic model is used simply to determine a floor reaction 
force from a provisional motion. This makes it possible to 
efficiently and promptly carry out the processing for 
generating a provisional motion and a desired motion and 
the processing for calculating a floor reaction force with 

15 respect to the provisional motion. 

Thus, according to the second invention, as with 
the first invention, it is possible to efficiently generate 
a gait capable of preventing a robot from slipping and also 
to successfully secure dynamic accuracy between a motion of 

20 the gait and a floor reaction force while ensuring temporal 
coordination therebetween at the same time. 

Further, according to a third invention of a gait 
producing device for a moving robot in accordance with the 
present invention, there is provided a gait producing 

25 device that sets a desired ZMP of a moving robot and a 

permissible range of a translational floor reaction force 
horizontal component generated by a motion of the moving 
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robot, and generates a desired gait that includes at least 
a desired motion of the moving robot such that the desired 
ZMP and the permissible range of the translational floor 
reaction force horizontal component are satisfied, 
5 comprising: 

a provisional motion creating means that uses a 
predetermined first dynamic model of the moving robot to 
create a provisional motion, which is a provisional value 
of the desired motion, such that the desired ZMP and the 

10 permissible range of the translational floor reaction force 
horizontal component are satisfied on the first dynamic 
model, and a provisional motion correcting means that 
corrects the created provisional motion by using the first 
dynamic model and a predetermined second dynamic model 

15 having a dynamic accuracy that is higher than that of the 

first dynamic model and obtains the corrected motion as the 
desired motion, 

wherein provided that, in relation to arbitrary 
time t of the provisional motion, a difference between 

20 ZMP2(t), which is a ZMP calculated at the time t on the 
second dynamic model from the provisional motion, and 
ZMPl(t), which is a ZMP calculated at time t on the first 
dynamic model from the provisional motion, (ZMP2(t)- 
ZMPl(t)) is defined as a ZMP error ZMPerr(t), and a 

25 difference between the translational floor reaction force 
horizontal component F2 (t) generated at the time t on the 
second dynamic model by the provisional motion and the 
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translational force horizontal component Fl(t) generated at 
the time t on the first dynamic model by the provisional 
motion (F2 ( t ) -Fl ( t ) ) is defined as a translational floor 
reaction force horizontal component error Ferr(t), then 
5 the provisional motion correcting means corrects 

an instantaneous value of the provisional motion at the 
time t such that a value obtained by adding either the ZMP 
error ZMPerr(t) or a ZMP correction amount determined on 
the basis of at least the ZMP error ZMPerr(t) to a ZMP 

10 calculated at the time t on the first dynamic model from a 
motion obtained after correcting the provisional motion 
agrees with the desired ZMP at the time t, and a value 
obtained by adding either the translational floor reaction 
force horizontal component error Ferr(t) or a floor 

15 reaction force correction amount determined on the basis of 
at least the translational floor reaction force horizontal 
component error Ferr(t) to the translational floor reaction 
force horizontal component generated at the time t on the 
first dynamic model by a motion obtained after correcting 

20 the provisional motion satisfies the permissible range at 
the time t . 

Incidentally, in the third invention, satisfying a 
desired ZMP for an arbitrary motion of a robot on an 
arbitrary dynamic model means that the horizontal component 
25 of a moment generated about the desired ZMP by the 

resultant force of an inertial force of the robot generated 
on the dynamic model by the motion (or a floor reaction 
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force moment horizontal component balancing out the moment) 
and the gravity acting on the robot becomes zero or 
substantially zero. The same will apply to a fourth 
invention to be discussed hereinafter. 
5 According to the third invention, the provisional 

motion creating means temporarily generates the provisional 
motion by using the first dynamic model such that the 
desired ZMP and the permissible range of the translational 
floor reaction force horizontal component are satisfied. 

10 Then, the provisional motion is corrected by the 

provisional motion correcting means and the corrected 
motion is obtained as a desired motion. Incidentally, the 
provisional motion will be equivalent to a provisional 
motion created by the provisional motion creating means in 

15 the first invention if the point of action of a floor 

reaction force moment in the first invention is defined as 
a desired ZMP. 

At this time, the provisional motion correcting 
means corrects an instantaneous value of a provisional 

20 motion at time t such that the value obtained by adding 

either the ZMP error ZMPerr(t) or a ZMP correction amount 
determined on the basis of at least the ZMP error ZMPerr(t) 
to a ZMP calculated at the time t on the first dynamic 
model by a motion obtained after correcting a provisional 

25 motion agrees with the desired ZMP at the time t. This 
means that a floor reaction force moment horizontal 
component corresponding to a ZMP error ZMPerr(t) or the ZMP 
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correction amount based thereon is generated about a 
desired ZMP. At the same time, as with the first invention 
described above, the provisional motion correcting means 
corrects an instantaneous value of a provisional motion at 
5 time t such that the value obtained by adding either the 
translational floor reaction force horizontal component 
error Ferr(t) or a floor reaction force correction amount 
determined on the basis of at least the translational floor 
reaction force horizontal component error Ferr(t) to a 

10 translational floor reaction force horizontal component 
generated at the time t on the first dynamic model by a 
motion obtained after correcting a provisional motion 
satisfies the permissible range at the time t. In this 
case, the ZMP error ZMPerr(t) at time t indicates the 

15 difference between a ZMP (ZMP2 (t) calculated at the time t 
on the second dynamic model from a provisional motion and a 
ZMP (ZMPl(t)) calculated at the time t on the first dynamic 
model from the provisional motion, so that it means an 
error of a ZMP on the first dynamic model corresponding to 

20 a provisional motion at the time t. Further, as in the 
case of the first invention, the translational floor 
reaction force horizontal component error Ferr(t) at time t 
means an error of a translational floor reaction force 
horizontal component on the first dynamic model 

25 corresponding to a provisional motion at the time t. 

Accordingly, a desired motion obtained by 
correcting a provisional motion as described above ensures 
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temporal coordination between itself and a floor reaction 
force. Incidentally, correcting a provisional motion as 
described above is equivalent to correcting a provisional 
motion in the first invention when the point of action of a 
5 floor reaction force moment in the first invention is 
defined as a desired ZMP. 

Further, a ZMP (referred to as ZMPl'(t) here) 
obtained by adding the ZMP error ZMPerr(t) or the ZMP 
correction amount based on the ZMPerrr(t) to a ZMP 

10 calculated on the first dynamic model from the desired 

motion approximates a ZMP calculated on a second dynamic 
model from the desired motion, so that ZMPl'(t) has high 
dynamic accuracy on a desired motion. And, as in the case 
of the first invention, a translational floor reaction 

15 force horizontal component Fl'(t) obtained by adding the 
translational floor reaction force horizontal component 
error Ferr(t) or the floor reaction force correction amount 
based on the Ferrr(t) to a translational floor reaction 
force horizontal component generated on a first dynamic 

20 model by the desired motion also has high dynamic accuracy 
on a desired motion. Therefore, determining a desired 
motion (correcting a provisional motion) such that these 
ZMPl'(t) and Fl'(t) satisfy the desired ZMP and the 
permissible range, respectively, makes it possible to 

25 generate a desired gait having high dynamic accuracy while 
properly satisfying the desired ZMP and the permissible 
range . 
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Further, as with the first invention, the 
aforesaid provisional motion and the correction of this 
provisional motion (the generation of a desired motion) are 
performed on the first dynamic model, and the second 
5 dynamic model is used simply to determine a floor reaction 
force from a provisional motion. This makes it possible to 
efficiently and promptly carry out the processing for 
generating a provisional motion and a desired motion and 
the processing for calculating a floor reaction force with 

10 respect to the provisional motion. 

Thus, according to the third invention, it is 
possible to efficiently generate a gait capable of 
preventing a robot from slipping and also to successfully 
secure dynamic accuracy between a motion of the gait and a 

15 floor reaction force while ensuring temporal coordination 
therebetween at the same time. 

Further, to fulfill the aforesaid object, 
according to a fourth invention of a gait producing device 
for a moving robot in accordance with the present invention, 

20 there is provided a gait producing device that sets a 

desired ZMP of a mobile body and a permissible range of a 
translational floor reaction force horizontal component 
generated by a motion of the moving robot and generates a 
desired gait that includes at least a desired motion of a 

25 moving robot such that the desired ZMP and the permissible 
range of the translational floor reaction force horizontal 
component are satisfied, comprising: 
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a provisional motion creating means that uses a 
predetermined first dynamic model of the moving robot to 
create a provisional motion, which is a provisional value 
of the desired motion, such that the desired ZMP and the 
5 permissible range of the translational floor reaction force 
horizontal component are satisfied on the first dynamic 
model, and a provisional motion correcting means that 
corrects the created provisional motion by using the first 
dynamic model and a predetermined second dynamic model 

10 having a dynamic accuracy that is higher than that of the 

first dynamic model and obtains the corrected motion as the 
desired motion, 

wherein provided that, in relation to arbitrary 
time t of the provisional motion, a difference between 

15 ZMP2(t), which is ZMP calculated at the time t on the 

second dynamic model from the provisional motion, and a 
desired ZMP(t)., which is the desired ZMP at the time t 
(ZMP2 (t) -desired ZMP(t)) is defined as a ZMP error 
ZMPerr(t), and a difference between the translational floor 

20 reaction force horizontal component F2(t) generated at the 
time t on the second dynamic model by the provisional 
motion and the translational floor reaction force 
horizontal component Fl(t) generated at the time t on the 
first dynamic model by the provisional motion ( F2 ( t ) -Fl ( t ) ) 

25 is defined as a translational floor reaction force 
horizontal component error Ferr(t), then 

the provisional motion correcting means corrects 
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an instantaneous value of the provisional motion at the 
time t such that a value obtained by adding either the ZMP 
error ZMPerr(t) or a ZMP correction amount determined on 
the basis of at least the ZMP error ZMPerr(t) to a ZMP 
5 calculated at the time t on the first dynamic model from a 
motion obtained after correcting the provisional motion 
agrees with the desired ZMP(t) at the time t, and a value 
obtained by adding either the translational floor reaction 
force horizontal component error Ferr(t) or a floor 

10 reaction force correction amount determined on the basis of 
at least the translational floor reaction force horizontal 
component error Ferr(t) to the translational floor reaction 
force horizontal component generated at the time t on the 
first dynamic model by a motion obtained after correcting 

15 the provisional motion satisfies the permissible range at 
the time t. 

The fourth invention differs from the third 
invention only in the aspect that the difference between 
the ZMP2(t), which is a ZMP calculated at the time t on the 

20 second dynamic model from the provisional motion and the 
desired ZMP(t), which is the desired ZMP at the time t, 
(ZMP2 (t) -desired ZMP(t)) is defined as the ZMP error 
ZMPerr(t). In other words, the provisional motion is 
generated such that the desired ZMP is satisfied, so that 

25 the provisional motion causes a ZMP calculated on the first 
dynamic model from the provisional motion to agree or 
substantially agree with the desired ZMP. Hence, the 
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fourth invention has been constructed as described above. 

According to the fourth invention, a desired 
motion obtained by correcting a provisional motion ensures 
temporal coordination between itself and a floor reaction 
5 force, as with the third invention. 

Moreover, as with the third invention, a desired 
gait with high dynamic accuracy can be generated while 
properly satisfying a desired value and a permissible range 
at the same time by determining a desired motion 

10 (correcting a provisional motion) such that the ZMP 

obtained by adding either the ZMP error ZMPerr(t) or the 
ZMP correction amount based on the ZMPerr(t) to a ZMP 
calculated on the first dynamic model from the desired 
motion satisfies the desired ZMP and also the translat ional 

15 floor reaction force horizontal component Fl' (t) obtained 
by adding either the translational floor reaction force 
horizontal component error Ferr(t) or the floor reaction 
force correction amount based on the Ferr(t) to a 
translational floor reaction force horizontal component 

20 generated on the first dynamic model by the desired motion 
satisfies the permissible range. 

Further, as with the third invention, the 
provisional motion and the correction of the provisional 
motion (the generation of a desired motion) are performed 

25 on the first dynamic model, and the second dynamic model is 
used simply to determine a floor reaction force from a 
provisional motion. This makes it possible to efficiently 
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and promptly carry out the processing for generating a 
provisional motion and a desired motion and the processing 
for calculating a floor reaction force with respect to the 
provisional motion . 
5 Thus, according to the fourth invention, it is 

possible to efficiently generate a gait capable of 
preventing a robot from slipping and also to successfully 
secure dynamic accuracy between a motion of the gait and a 
floor reaction force while ensuring temporal coordination 

10 therebetween at the same time. 

Incidentally, if a desired gait includes a desired 
floor reaction force in addition to a desired motion in the 
first to the fourth inventions explained above, then the 
Ml' (t) and Fl' (t) , for example, may be defined as 

15 constituent elements of a desired floor reaction force in 
the first and the second inventions described above, and 
the ZMPl' (t) and Fl' (t) , for example, may be defined as 
constituent elements of a desired floor reaction force in 
the third and the fourth inventions described above. 

20 Alternatively, M2(t) and F2 (t) may be defined as 

constituent elements of a desired floor reaction force in 
the first and the second inventions described above, and 
ZMP2 (t) and F2 (t) may be defined as constituent elements of 
a desired floor reaction force in the third and the fourth 

25 inventions described above. 

Further, in the first to the fourth inventions, 
desired gaits generated thereby may be further corrected by 
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using a full model (a third dynamic model) , as in the 
aforesaid patent documents 2 and 3. In this case, the 
desired gaits generated in the first to the fourth 
inventions have high dynamic accuracy, making gaits in full 
5 models resistant to divergence- This makes it possible to 
prevent a correction amount of a desired ZMP trajectory or 
a floor reaction force moment about a desired ZMP from 
becoming excessive and maintain a large stability margin of 
a robot. 

10 

Best Mode for Carrying Out the Invention 

The following will explain an embodiment of the 
present invention with reference to the accompanying 
drawings. In the embodiment in the present description, as 

15 a moving robot, a bipedal moving robot will be used as an 
example of a moving robot. 

Fig. 1 is a schematic diagram showing the outline 
of the entire construction of a bipedal moving robot to 
which an embodiment of the present invention is applied. 

20 As shown in the figure, a bipedal moving robot 

(hereinafter referred to as "the robot") 1 is equipped with 
a pair of right and left leg bodies (leg links) 2, 2 
extended downward from a body (a base body of the robot 1) 
3. The two leg bodies 2, 2 share the same construction, 

25 each having six joints. The six joints are comprised of, 
in the following order from the body 3 side, joints 10R, 
10L for swinging (rotating) a hip (waist) (for rotating in a 
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yaw direction relative to the body 3) , joints 12R, 12L for 
rotating the hip (waist) in a roll direction (about an X 
axis)., joints 14R, 14L for rotating the hip (waist) in a 
pitch direction (about a Y axis) , joints 16R, 16L for 
5 rotating knees in the pitch direction, joints 18R, 18L for 
rotating ankles in the pitch direction, and joints 20R, 20L 
for rotating the ankles in the roll direction. In the 
present description, the symbols R and L mean that they 
correspond to the right side and the left side, 

10 respectively, of the robot 1. 

A foot (foot portion) 22R(L) constituting a distal 
portion of each leg body 2 is attached to the bottoms of 
the two joints 18R(L) and 20R(L) of the ankle of each leg 
body 2. The aforesaid body 3 is installed at the uppermost 

15 top of the two leg bodies 2, 2 through the intermediary of 
the three joints 10R(L), 12R(L) and 14R(L) of the hip of 
each leg body 2. A control unit 60 and the like, which 
will be discussed in detail hereinafter, is housed in the 
body 3. For the sake of convenience of illustration, the 

20 control unit 60 is shown outside the body 3 in Fig. 1. 

. In each leg body 2 having the aforesaid 
construction, a hip joint (or a waist joint) is formed of 
the joints 10R(L), 12R(L) and 14R(L), the knee joint is 
formed of the joint 16R(L), and the ankle joint is formed 

25 of the joints 18R(L) and 20R(L). The hip joint and the 
knee joint are connected by a thigh link 24R(L), and the 
knee joint and the ankle joint are connected by a crus link 
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26R(L) . 

A pair of right and left arm bodies 5, 5 is 
attached to both sides of an upper portion of the body 3, 
and a head 4 is disposed at a top end of the body 3. Each 
5 arm body 5 is provided with a shoulder joint composed of 
three joints 30R(L), 32R(L), and 34R(L), an elbow joint 
composed of a joint 36R(L), a wrist joint composed of a 
joint 38R(L), and a hand 40R(L) connected to the wrist 
joint. The links between the shoulder joint and the elbow 

10 joint, and between the elbow joint and the wrist joint, 
respectively, are formed of rigid bodies. 

The construction of the robot 1 described above 
imparts six degrees of freedom to the foot 22R(L) of each 
leg body 2 relative to the body 3. During a travel, such 

15 as walking, of the robot 1, desired motions of the two feet 
22R and 22L can be accomplished by driving 6*2=12 joints of 
the two leg bodies 2, 2 together ("*" in this description 
denotes multiplication for scalar calculation, while it 
denotes an outer product in vector calculation) at 

20 appropriate angles. This arrangement enables the robot 1 
to arbitrarily move in a three-dimensional space. 
Furthermore, each arm body 5 is capable of performing a 
motion, such as arm swinging, by rotating the shoulder 
joint, the elbow joint, and the wrist joint thereof. 

25 As shown in Fig. 1, a publicly known six-axis 

force sensor 50 is provided under the ankle joints 18R(L), 
20R(L) and between the ankle joints and the foot 22R(L) of 
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each leg body 2. The six-axis force sensor 50 detects 
primarily whether the foot 22R(L) of each leg body 2 is in 
contact with the ground and a floor reaction force (ground 
contact load) acting on each leg body 2, and it outputs 
5 detection signals of three-direction components Fx, Fy and 
Fz of a translational force of the floor reaction force and 
three-direction components Mx, My and Mz of a moment to the 
control unit 60. Furthermore, the body 3 is equipped with 
a posture sensor 54 for detecting an inclination angle of 

10 the body 3 relative to a Z-axis (vertical direction 

(gravitational direction) ) and an angular velocity thereof, 
detection signals thereof being output from the posture 
sensor 54 to the control unit 60. The posture sensor 54 is 
provided with an accelerometer and a gyro sensor, which are 

15 not shown, and the detection signals of these sensors are 
used to detect posture angles (inclination angles) of the 
body 3 and angular velocities thereof. Although detailed 
structures are not shown, each joint of the robot 1 is 
provided with an electric motor 64 (refer to Fig. 3) for 

20 driving the joint and an encoder (rotary encoder) 65 (refer 
to Fig. 3) for detecting a rotational amount of the 
electric motor 64 (a rotational angle of each joint). 
Detection signals of the encoder 65 are output from the 
encoder 65 to the control unit 60. 

25 Furthermore, although not shown in Fig. 1, a 

joystick (operating device) 73 (refer to Fig. 3) for 
manipulating the robot 1 is provided on the exterior of the 
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robot 1. The joystick 73 is constructed in such a manner 
that a request or a restrictive condition on a gait of the 
robot 1, such as turning the robot 1 that is traveling 
straight, specifying the moving direction of the robot 1, 
5 or specifying a motion mode of the robot 1, such as walking 
or running, or a frictional condition of a floor surface 
(road surface condition) , is input to the control unit 60 
as necessary by operating the joystick 73. Communication 
between the joystick 73 and the control unit 60 is effected 

10 by a wire or wireless means. 

Fig. 2 schematically shows the basic construction 
of the distal portion (including each foot 22R(L)) of each 
leg body 2 in the present embodiment. As shown in the 
figure, a spring mechanism 70 is installed between each 

15 foot 22R(L) and the aforesaid six-axis force sensor 50, and 
a foot sole elastic member 71 made of rubber or the like is 
bonded to a foot sole (the bottom surface of each foot 
22R,L). These spring mechanism 70 and the foot sole 
elastic member 71 constitute a compliance mechanism 72. 

20 Although no detailed illustration is given, the spring 

mechanism 70 is constructed of a square guide member (not 
shown) , which is installed on the upper surface of the foot 
22R(L), and a piston-shaped member (not shown) that is 
installed adjacently to the ankle joint 18R(L) (the ankle 

25 joint 20R(L) being omitted in Fig. 2) and the six-axis 

force sensor 50 and housed in the guide member through the 
intermediary of an elastic member (rubber or spring) so 
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that it may be moved extremely slightly. 

The foot 22R(L) indicated by a solid line in Fig. 
2 is in a state wherein it is being subjected to no floor 
reaction force. When each leg body 2 is subjected to a 
5 floor reaction force, the spring mechanism 70 and the foot 
sole elastic member 71 of the compliance mechanism 72 flex, 
causing the foot 22R(L) to shift to the position/posture 
illustrated by a dashed line in the figure. The structure 
of the compliance mechanism 72 is important not only to 

10 ease a landing impact but also to enhance controllability. 
The details thereof have been explained in, for example, 
Japanese Unexamined Patent Publication Application No. 5- 
305584 previously proposed by the present applicant, so 
that no further explanation will be given in the present 

15 description. 

Fig. 3 is a block diagram showing the construction 
of the control unit 60. The control unit 60 is comprised 
of a microcomputer, and it includes a first calculator 90 
and a second calculator 92 formed of CPUs, an A/D converter 

20 80, a counter 86, a D/A converter 96, a RAM 84, a ROM 94, 

and a bus line 82 for transferring data among them. In the 
control unit 60, output signals of the six-axis force 
sensor 50 of each leg body 2, the posture sensor 54 (an 
accelerometer and a rate gyro sensor) , the joystick 73, etc. 

25 are converted into digital values by the A/D converter 80 

and sent to the RAM 84 via the bus line 82. Outputs of the 
encoder 65 (rotary encoder) of each joint of the robot 1 
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are input to the RAM 84 via the counter 86. 

As will be discussed hereinafter, the first 
calculator 90 generates a desired gait, calculates a joint 
angle displacement command (a command value of a 
5 displacement angle of each joint or a rotational angle of 
each electric motor 64), and sends the calculated command 
to the RAM 84. The second calculator 92 reads the joint 
angle displacement command and an actual measurement value 
of a joint angle detected on the basis of an output signal 

10 of the encoder 65 from the RAM 84 to calculate a 

manipulated variable required for driving each joint and 
outputs the calculated manipulated variable to the electric 
motor 64 for driving each joint through the intermediary of 
the D/A converter 96 and a servo amplifier 64a. 

15 Fig. 4 is a block diagram showing major functional 

construction of the control unit 60 of the robot 1 in an 
embodiment in the present description. A portion except 
the "actual robot" in Fig. 4 is constituted of processing 
functions implemented by the control unit 60 (primarily the 

20 functions of the first calculator 90 and the second 

calculator 92) . The processing function is implemented by 
programs or the like installed in the control unit 60. In 
the following explanation, the aforesaid symbols R and L 
will be omitted as long as it is not particularly necessary 

25 to discriminate right and left of each portion of the robot 
1 (the leg bodies 2, the arm bodies 5, etc.). 

An explanation will be given below. The control 
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unit 60 is equipped with a gait producing device 100 that 
generates and outputs desired gaits freely in real time, as 
it will be discussed later. The gait producing device 100 
implements an embodiment of the present invention by its 
5 functions. A desired gait output by the gait producing 
device 100 is constituted of a corrected desired body 
posture trajectory (the trajectory of desired postures of 
the body 3), a corrected desired body position trajectory 
(the trajectory of desired positions of the body 3) , a 

10 desired foot position/posture trajectory (the trajectories 
of desired positions and desired postures of the feet 22), 
a desired arm posture trajectory (the trajectory of desired 
postures of each arm body) , a desired ZMP (desired total 
floor reaction force central point) trajectory, the 

15 trajectory of corrected desired floor reaction force 

moments about a desired ZMP, and a desired total floor 
reaction force trajectory. If a portion (a head or the 
like) that can be moved relative to the body 3 is provided 
in addition to the leg bodies 2 and the arm bodies 5, then 

20 a desired position/posture trajectory of the movable 
portion is added to a desired gait. 

Here, the definitions and the like of basic terms 
related to gaits in the present description will be 
explained. The term "tra j ectory" in a gait means a 

25 temporal change pattern (time series pattern) and it may be 
referred to as "pattern" in place of "trajectory." Further, 
a "posture" means a spatial orientation. For example, a 
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body posture is represented by an inclination angle 
(posture angle) of the body 3 in the roll direction (about 
the X-axis) relative to the Z-axis (vertical axis) and an 
inclination angle (posture angle) of the body 3 in the 
5 pitch direction (about the Y-axis) , and a foot posture is 
represented by means of a two-axis spatial azimuth fixedly 
set on each foot 22. In the present description, a body 
posture may be referred to as a body posture angle. 
Desired arm postures related to the arm bodies 5 are 

10 represented in terms of relative postures with respect to 
the body 3 in the embodiment in the present description. 

The position of the body means the position of a 
predetermined representative point of the body 3 (a certain 
fixed point in a local coordinate system arbitrarily and 

15 fixedly set relative to the body 3) . Similarly, the 

position of a foot means the position of a predetermined 
representative point of each foot 22 (a fixed point in a 
local coordinate system arbitrarily and fixedly set 
relative to each foot 22). For example, the representative 

20 point of each foot 22 is set on the bottom surface of each 
foot 22 (more specifically, for example, a point at which a 
perpendicular line from the center of the ankle joint of 
each leg body 2 to the bottom surface of each foot 22 
intersects with the bottom surface) . 

25 The aforesaid corrected desired body posture and 

corrected desired body position related to the body 3 are 
obtained by correcting a certain desired body posture 
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(provisional desired body posture) and a desired body 
position (provisional desired body position) that provide 
references. In the embodiment in the present description, 
the desired body position/posture determined by a 
5 simplified model gait generator, which will be discussed 

later (the desired body position/posture determined in S032 
of Fig. 10, which will be discussed later) , correspond to 
the desired body position/posture that provide references. 

In the explanation hereinafter, the term "desired" 

10 will be frequently omitted if there is no danger of 
misunderstanding . 

In a gait, the constituent elements except those 
related to a floor reaction force, namely, the constituent 
elements related to the position/posture of each portion of 

15 the robot 1, such as foot position/posture and body 
position/posture, will be referred generically to 
"motions." Further, a floor reaction force acting on each 
foot 22 (a floor reaction force composed of a translational 
force and a moment) will be referred to as "the floor 

20 reaction force of each foot," and the resultant force of 
"the floor reaction forces of individual feet" related to 
all (two) feet 22R and 22L of the robot 1 will be referred 
to as "the total floor reaction force." However, in the 
following explanation, the floor reaction force of each 

25 foot will be hardly referred to, so that "the floor 

reaction force" will be handled as synonymous with "the 
total floor reaction force" unless otherwise specified. 
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A desired floor reaction force is generally 
represented in terms of a point of action and a 
translational force and moment acting on the point. The 
point of action can be set anywhere, so that innumerable 
5 expressions are conceivable for the same desired floor 

reaction force; if, however, a desired floor reaction force 
is represented using, in particular, a desired floor 
reaction force central point (the desired position of the 
central point of a total floor reaction force) as the point 

10 of action, then the moment component of the desired floor 
reaction force except for a vertical component (the moment 
component about a vertical axis (Z-axis)) will be zero. In 
other words, a horizontal component (the moment about 
horizontal axes (X-axis and Y-axis) ) of the moment of the 

15 desired floor reaction force about the desired floor 
reaction force central point will be zero. 

In a gait that satisfies a dynamic balance 
condition, the ZMP calculated from a desired motion 
trajectory of the robot 1 (the point at which a moment 

20 excluding its vertical component becomes zero, the moment 
acting about the point due to the resultant force of the 
inertial force calculated from the desired motion 
trajectory and the gravity) coincides with the desired 
floor reaction force central point. This is, therefore, 

25 equivalent to providing a desired ZMP trajectory in place 

of a desired floor reaction force central point trajectory. 
Here, when walking of the robot 1 is performed, 
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the vertical component of a translational floor reaction 
force is subordinately determined when the vertical 
position of the body 3 (body height) of the robot 1 is 
determined by the technique for determining a body height 
5 previously proposed in, for example, Japanese Unexamined 

Patent Application Publication No. 10-86080 by the present 
applicant. Furthermore, the horizontal component of the 
translational floor reaction force is also subordinately 
determined when the body horizontal position trajectory (or 

10 the position trajectory of the total center-of -gravity ) of 
the robot 1 is determined such that the horizontal 
component of the moment generated about a desired ZMP by 
the resultant force of an inertial force attributable to a 
motion of a desired gait and gravity becomes zero. For 

15 this reason, when performing the walking of the robot 1, 
only the desired ZMP may be set as the physical amount to 
be explicitly set in relation to a floor reaction force of 
the desired gait. 

Meanwhile, if a travel of the robot 1, e.g., 

20 running of the robot 1, is performed with a gait that 
includes a period during which a floor reaction force 
becomes zero or substantially zero, then a translational 
floor reaction force vertical component is also important 
in controlling the operation of the robot 1. Hence, it is 

25 preferred to explicitly set the desired trajectory of the 
translational floor reaction force vertical component and 
then to determine the trajectory of a desired body vertical 
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position or the like of the robot 1. Also, when walking of 
the robot 1 is performed, if the robot 1 is to travel on a 
floor surface with a low friction coefficient (on a low-jj, 
road) , it is preferred to explicitly set a desired 
5 trajectory of a translational floor reaction force vertical 
component to prevent slippage or the like of the robot 1, 
because the translational floor reaction force vertical 
component (more precisely, a component of the translational 
floor reaction force that is perpendicular to the floor 

10 surface) influences a frictional force. Furthermore, 

according to the embodiment of the present invention, in a 
desired gait finally output by the gait producing device 
100, a corrected desired floor reaction force moment (a 
moment whose horizontal component is not necessarily zero) 

15 is generated about a desired ZMP. 

Thus, in the embodiment of the present description, 
the constituent elements related to the floor reaction 
forces of desired gaits output from the gait producing 
device 100 include a corrected desired floor reaction force 

20 moment about a desired ZMP and a desired translational 

floor reaction force vertical component in addition to a 
desired ZMP trajectory. 

And, in the present description, a desired gait 
output by the gait producing device 100 is used to mean "a 

25 set of a desired motion trajectory and a desired floor 

reaction force trajectory in the period of one step or a 
plurality of steps" in a broad sense, and to mean "a set of 
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a desired motion trajectory and a desired floor reaction 
force trajectory that includes a desired ZMP, a corrected 
desired floor reaction force moment and a desired 
translational floor reaction force vertical component in 
5 the period of one step" in a narrow sense. 

However, according to the embodiment of the 
present description, in a desired gait (provisional desired 
gait) prepared in the process before a final desired gait 
(a desired gait output from the gait producing device 100) 

10 is determined, a gait obtained by removing a corrected 

desired floor reaction force moment from the desired gait 
in the aforesaid narrow sense is used to mean a desired 
gait. Supplementally, according to the embodiment in the 
present description, a desired gait (a provisional desired 

15 gait) prepared in the process before a final desired gait 

(a desired gait output by the gait producing device 100) is 
determined is closely associated with the present invention. 
Hence, the majority of a desired gait appearing in the 
following explanation will be used to mean a gait obtained 

20 by removing a corrected desired floor reaction force moment 
from a desired gait in the aforesaid narrow sense. 

In the following explanation, "a floor reaction 
force vertical component" will mean "a translational floor 
reaction force vertical component," and the vertical 

2 5 component (a component about a vertical axis) of the moment 
in a floor reaction force will use the term "moment" to 
distinguish it from "a floor reaction force vertical 
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component." Similarly, "a floor reaction force horizontal 
component" will mean "a translational floor reaction force 
horizontal component." A translational floor reaction 
force will sometimes be referred to as a floor reaction 
5 force translational force component. 

"One step" of a desired gait will be used to mean 
a period from the moment one leg body 2 of the robot 1 
lands to the moment the other leg body 2 lands. 

A two-leg supporting period in a gait refers to a 

10 period during which the robot 1 supports its own weight by 
the two leg bodies 2, 2, a one-leg supporting period refers 
to a period during which the robot 1 supports its own 
weight only by one leg body 2, and a floating period refers 
to a period during which both leg bodies 2, 2 are apart 

15 from a floor (floating in the air) . In the one-leg 

supporting period, the leg body 2 not supporting the self- 
weight of the robot 1 is referred to as a free leg. A 
running gait of the robot 1, in which the one-leg 
supporting period and the floating period are alternately 

20 repeated, does not have the two-leg supporting period. In 
this case, during the floating period, both leg bodies 2, 2 
do not support the self-weight of the robot 1; however, for 
the sake of convenience, the leg body 2 that was a free leg 
and the leg body 2 that was a supporting leg during a one- 

25 leg supporting period immediately before the floating 

period will be referred to as a free leg and a supporting 
leg, respectively, even in the floating period. 
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The trajectory of a desired gait is described 
using a global coordinate system (a coordinate system fixed 
to a floor) . As a global coordinate system, a supporting 
leg coordinate system defined, for example, on the basis of 
5 landing position/posture of the foot 22 of a supporting leg 
is used. This supporting leg coordinate system is, for 
example, a coordinate system in which the point at which a 
perpendicular line extended to a floor surface from the 
center of the ankle joint to which the foot 22 is connected 

10 intersects with the floor, while substantially the entire 
bottom surface of the foot 22 of the supporting leg is in 
contact with the floor, is defined as the origin, and when 
the foot 22 of the supporting leg is projected onto a 
horizontal plane that passes the origin, the longitudinal 

15 direction of the foot 22 is defined as the X-axis direction 
and the lateral direction is defined as the Y-axis 
direction (the Z-axis direction being the vertical 
direction) . In the following explanation, the X, Y, Z 
coordinates will mean the coordinates in this supporting 

20 leg coordinate system unless otherwise specified. 

Fig. 5 is a block diagram showing the details of 
the gait producing device 100. Referring to this Fig. 5, 
more specific overview of the processing of the gait 
producing device 100 will be explained below. 

25 As illustrated, the gait producing device 100 is 

equipped with a gait parameter determiner 100a. The gait 
parameter determiner 100a determines the values of gait 
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parameters or a time series table that defines a desired 
gait . 

According to the embodiment of the present 
description, a gait parameter determined by the gait 
5 parameter determiner 100a includes the parameters that 
define a desired foot position/posture trajectory, a 
desired arm posture trajectory, a desired ZMP trajectory, 
and a desired floor reaction force vertical component 
trajectory, respectively, of a desired gait. 

10 When the gait producing device 100 generates a 

desired gait, expected landing position/posture and 
expected landing time of the free leg foot 22, or basic 
required values (required parameters) for generating a gait, 
such as the length of a step and moving velocity, are 

15 supplied to the gait producing device 100 from the 

aforesaid joystick 73 or an action planner (a device for 
preparing action plans of the robot 1) , which is not shown. 
Alternatively, the gait producing device 100 reads the 
required parameters from a storage medium in which the 

20 aforesaid required parameters have been stored beforehand 
and retained. Then, the gait parameter determiner 100a of 
the gait producing device 100 determines a gait parameter 
on the basis of the required parameters. 

In the embodiment of the present description, the 

25 gait parameter determined by the gait parameter determiner 
100a also includes parameters that define a reference body 
posture trajectory, a ZMP permissible range, and a floor 
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reaction force horizontal component permissible range, 
respectively. 

Although the aforesaid reference body posture 
trajectory is not the one finally output from the gait 
5 producing device 100, it is referred to when determining a 
desired gait. The reference body posture trajectory is 
supplied in relation to the body posture of the robot 1 
from the joystick 73 or the action planner, or it is a body 
posture trajectory generated directly on the basis of a 

10 requirement (a requirement for retaining a body posture at 
a vertical posture, or the like) that has been set in 
advance. A desired body posture (hereinafter, "body 
posture" with no "reference" attached thereto will indicate 
a desired body posture) is generated such that it follows 

15 or coincides with a reference body posture for a long time. 

To add a supplemental explanation regarding the 
aforesaid ZMP permissible range, in the embodiment in the 
present description, a desired gait is corrected so as to 
generate a corrected desired floor reaction force moment 

20 (this generally being not zero) about a desired ZMP. 

Therefore, the desired ZMP will be a point having a 
different definition from an original definition (the 
definition in that it is a point with zero floor reaction 
force moment horizontal component) , and a ZMP that 

25 satisfies the original definition (hereinafter referred to 
as true ZMP) moves to a position shifted from the desired 
ZMP by a value obtained by dividing the corrected desired 
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floor reaction force moment by a desired floor reaction 
force vertical component. 

The true ZMP of a corrected gait (the desired gait 
finally output from the gait producing device 100) must 
5 fall within a range wherein at least ZMP can exist (a so- 
called supporting polygon: a range wherein a floor 
reaction force point of action (ZMP) can exist when it is 
assumed that no adhesive force acts between a floor and the 
bottom surface of the foot 22) . Further, in order to 

10 secure a sufficient stability margin of the robot 1, the 
true ZMP of a corrected gait preferably falls within a 
range near the center in the range wherein the ZMP can 
exist. Hence, in the embodiment in the present description, 
a permissible range wherein a true ZMP of a corrected gait 

15 can exist is set. This range is called a ZMP permissible 

range. The ZMP permissible range is set to coincide with a 
range wherein a ZMP can exist or to be included in a range 
wherein a ZMP can exist. 

As described above, the value obtained by dividing 

20 a corrected desired floor reaction force moment about a 
desired ZMP by a desired floor reaction force vertical 
component indicates the amount of positional deviation of a 
true ZMP from the desired ZMP; therefore, the amount of 
positional deviation of the true ZMP from the desired ZMP 

25 (a ZMP-converted value of a corrected desired floor 

reaction force moment) may be set instead of setting the 
corrected desired floor reaction force moment about the 
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desired ZMP. Moreover, a ZMP permissible range can be 
converted into a permissible range of a corrected desired 
floor reaction force moment by multiplying the position of 
its boundary by a desired floor reaction force vertical 
5 component, and the permissible range of the corrected 

desired floor reaction force moment may be set in place of 
a ZMP permissible range. 

The aforesaid floor reaction force horizontal 
component permissible range is the permissible range of a 

10 floor reaction force horizontal component that makes it 

possible to generate a frictional force of a magnitude that 
prevents the foot 22 from slipping on the surface of foot 
22 of the robot 1 that is in contact with a floor. 
According to the embodiment in the present description, at 

15 least a motion of a desired gait (a desired motion) finally 
output from the gait producing device 100 is generated such 
that a floor reaction force horizontal component balancing 
out the horizontal component of an inertial force of the 
robot 1 that is produced thereby falls within a floor 

20 reaction force horizontal component permissible range (such 
that a floor reaction force horizontal component 
permissible range is satisfied) . 

The floor reaction force horizontal component 
permissible range set in the embodiment in the present 

25 description comes in one for normal gaits set by the 

processing of S022 to be discussed hereinafter, one for 
standard gaits set by the processing of S026, and one for 
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gait corrections (for full-model corrections) set in S030. 
However, these floor reaction force horizontal component 
permissible ranges do not necessarily have to differ from 
each other; they may be the same. Meanwhile, the ZMP 
5 permissible range is only the one for gait corrections (for 
full-model corrections) set by the processing of S030. 

Supplementally, a gait parameter for generating a 
desired gait includes parameters in addition to the 
aforesaid parameters. They are determined in the gait 

10 parameter determiner 100a such that they satisfy 
predetermined boundary conditions. 

The gait parameter determined by the gait 
parameter determiner 100a is input to a desired 
instantaneous value generator 100b. Based on the input 

15 gait parameter, the desired instantaneous value generator 
100b sequentially calculates (generates) the instantaneous 
values (values for each predetermined control processing 
cycle of the aforesaid control unit 60) of the constituent 
elements of a part of a desired gait (excluding desired 

20 body position/posture) , such as a reference body posture, 
desired foot position/posture, a desired ZMP, a desired 
floor reaction force vertical component, a ZMP permissible 
range, and a floor reaction force horizontal component 
permissible range. Furthermore, the desired instantaneous 

25 value generator 100b also outputs a translational floor 

reaction force (a translational force component of a floor 
reaction force) error trajectory (specifically, a time 
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series of the instantaneous values of errors of a 
translational floor reaction force horizontal component) 
and a floor reaction force moment error trajectory 
(specifically, a time series of the instantaneous values of 
5 errors of the horizontal component of a floor reaction 
force moment about a desired ZMP) . These error 
trajectories correspond to the time series patterns of 
errors of a floor reaction force generated on a simplified 
model (a first dynamic model) , which will be discussed 

10 later, with respect to a floor reaction force generated by 
a semi-full model (a second dynamic model) , which will be 
discussed later, by a motion of a gait. 

The desired instantaneous values calculated by the 
desired instantaneous value generator 100b are input to a 

15 simplified model gait generator 100c - Based on the input 
desired instantaneous values, the simplified model gait 
generator 100c calculates the instantaneous values of 
desired body position/posture (provisional desired body 
position/posture for a full-model corrector, which will be 

20 discussed hereinafter) by using a simplified model (the 
first dynamic model) and a semi-full model (a second 
dynamic model) , which will be discussed hereinafter, as the 
dynamic models approximately expressing a relationship 
between a motion of the robot 1 and a floor reaction force. 

25 The simplified model used here is the same as that used by 
the desired instantaneous value generator 100b. The 
simplified model gait generator 100c calculates the 
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instantaneous values of the desired body position/posture 
such that a predetermined dynamic condition related to a 
floor reaction force moment about a desired ZMP and a 
translational floor reaction force is satisfied. The 
5 dynamic condition is a condition that a floor reaction 

force moment horizontal component obtained by correcting a 
floor reaction force moment horizontal component about a 
desired ZMP that is generated on the simplified model by a 
motion of a gait on the basis of a floor reaction force 

10 moment error agrees or substantially agrees with a desired 
floor reaction force moment horizontal component (=0) , which 
is an original desired value of the floor reaction force 
moment horizontal component about the desired ZMP, and a 
translational floor reaction force horizontal component 

15 obtained by correcting a translational floor reaction force 
horizontal component generated on the simplified model by 
the motion of the gait on the basis of the translational 
floor reaction force error satisfies a floor reaction force 
horizontal component permissible range. Supplementally, in 

20 the embodiment of the present description, a desired floor 
reaction force vertical component trajectory is explicitly 
set, so that the instantaneous values of desired body 
position/posture are determined such that a dynamic 
condition in that the translational force vertical 

25 component of the resultant force of an inertial force 

produced by a desired motion and gravity (in other words, 
the resultant force of an inertial force and gravity 
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involved in a translational motion in the vertical 
direction of the total center-of-gravity of the robot 1) 
balances out a desired floor reaction force vertical 
component is also satisfied. 
5 The calculation processing of the simplified model 

gait generator 100c sequentially determines the 
instantaneous values of a desired gait (provisional desired 
gait) including desired body position/posture. Hereinafter, 
a desired gait having the desired body position/posture 
10 determined in the simplified model gait generator 100c as 
constituent elements will be referred to as a simplified 
model gait. 

The simplified model gait including the desired 
body position/posture determined by the simplified model 

15 gait generator 100c is input to a full-model corrector lOOd. 
The full-model corrector lOOd calculates a corrected 
desired body position/posture obtained by correcting the 
desired body position/posture of the simplified model gait 
by using a full model as a dynamic model having high 

20 dynamic accuracy, and also calculates a corrected desired 
floor reaction force moment, which is a desired value of a 
floor reaction force moment horizontal component about a 
desired ZMP. 

More generally, the full-model corrector lOOd 

25 carries out processing of El or E2 to satisfy the following 
conditions Dl to D3 . Specifically, the full-model 
corrector lOOd: 
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El) corrects the body position/posture of a simplified 

model gait, 

or 

E2) corrects the body position/posture of the simplified 
5 model gait and also outputs a corrected desired floor 
reaction force moment about a desired ZMP (corrects a 
desired floor reaction force) in order to satisfy the 
following conditions : 

Dl) A dynamic balance condition is satisfied with accuracy 

10 that is higher than a gait obtained by correcting a gait 
generated by using a simplified model (a simplified model 
gait) by using a displacement-dimension correction model 
(hereinafter referred to as a displacement-dimension 
corrected gait) ; 

15 D2) A true ZMP (a ZMP satisfying the original definition 
that has been corrected by generating a corrected desired 
floor reaction force moment about a desired ZMP) falls 
within a ZMP permissible range (a permissible range that 
allows a sufficient stability margin to be maintained) ; and 

20 D3) A floor reaction force horizontal component falls 
within a floor reaction force horizontal component 
permissible range . 

In the embodiment in the present description, the 
processing of E2 is carried out to satisfy the conditions 

25 Dl to D3 . The processing by the full-model corrector lOOd 
in the embodiment in the present description is the same as 
that explained in detail in, for example, PCT international 
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publication WO/03/057427 /Al previously proposed by the 
present applicant (specifically, the processing of S038 
shown in Fig. 13 of the publication) . Hence, detailed 
explanation of the processing by the full-model corrector 
5 lOOd will be omitted in the present description. 

Further, in the embodiment in the present 
description, a correction is made by the full-model 
corrector lOOd. Alternatively, however, such a correction 
may be omitted, and the instantaneous value of a simplified 
10 model gait may be directly output from the gait producing 
device 100. 

Supplementally, in the embodiment in t he present 
description, the gait parameter determiner 100a, the 
desired instantaneous value generator 100b, and the 

15 simplified model gait generator 100c carry out the 

processing related to the core of the present invention. 

Referring back to Fig. 4, the instantaneous values 
of a desired gait, including the instantaneous values of 
corrected desired body position/posture, a corrected 

20 desired floor reaction force moment about a desired ZMP, 
and desired foot position/posture determined as described 
above, are supplied to a composite-compliance control unit 
101 (the portion enclosed by the dashed line in Fig. 4) . 
The composite-compliance control unit 101 controls a joint 

25 actuator (an electric motor 64) so as to follow a desired 
gait, while maintaining the balance of the robot 1. More 
specific processing of the composite-compliance control 
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unit 101 will be discussed later. 

The embodiment of the present invention will now 
be explained further specifically. According to the 
present embodiment, for each control processing cycle of 
5 the control unit 60, the gait producing device 100 

determines instantaneous values of a desired gait by using 
a simplified model as the first dynamic model and a semi- 
full model as a second dynamic model, which will be 
explained in detail below. 
10 A body motion mode and dynamic models used for 

generating gaits in the present embodiment will now be 
explained. 

In a gait that includes a floating period, such as 
a running gait, or walking on a low-friction floor surface, 

15 there are cases where a dynamic balance condition cannot be 
satisfied while the floor reaction force horizontal 
component of a desired gait being within a permissible 
range (or within friction limits) simply by adjusting a 
body horizontal acceleration. Hence, in the present 

2 0 embodiment, two motion modes (a body translation mode and a 
body rotation mode) of the body 3 explained below are 
compositively generated so as to satisfy the dynamic 
balance condition while the floor reaction force horizontal 
component of a desired gait being within a permissible 

25 range (or within friction limits) . 

As shown in Fig. 6(a), if only a body horizontal 
acceleration is perturbed from a certain motion state, then 
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the total center-of-gravity horizontal acceleration and the 
angular momentum about the total center-of-gravity are 
perturbed. More specifically, in the perturbation of the 
body horizontal acceleration, the floor reaction force 
5 moment about a desired ZMP (excluding a component about a 
vertical axis) and a floor reaction force horizontal 
component (to be precise, a translational floor reaction 
force horizontal component) are perturbed without 
perturbing a floor reaction force vertical component (that 

10 dynamically balances out the resultant force of the 

inertial force generated thereby and gravity) . This motion 
mode is referred to as the body translation mode. 

In other words, a motion in which the horizontal 
component of a floor reaction force moment about a desired 

15 ZMP and a floor reaction force horizontal component 

(translational floor reaction force horizontal component) 
are changed without changing a floor reaction force 
vertical component is referred to as the body translation 
mode . 

20 A change in the floor reaction force moment 

component per unit acceleration at that time is denoted by 
AMp and a change in the floor reaction force horizontal 
component per unit acceleration is denoted by AFp. If the 
body 3 in the state shown in Fig. 6(a) is horizontally 

25 accelerated forward, then AMp and AFp act in the directions 
of the arrows shown in Fig. 6(a). 

For the ease of sensory perception, a floor 
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reaction force balancing out the resultant force of an 
inertial force generated by a motion and gravity has been 
used for the expression; however, an expression using the 
resultant force of the inertial force and gravity is 
5 theoretically accurate. Incidentally, the aforesaid 

resultant force and floor reaction force have the same 
magnitude but are in the opposite directions. 

Meanwhile, if a body posture angular acceleration 
is perturbed about a certain point Pr from a certain motion 

10 state as shown in Fig. 6(b), then the angular momentum 

about the total center-of -gravity is perturbed without the 
total center-of -gravity being perturbed. This means that 
the body posture angular acceleration perturbation about 
the point Pr perturbs a horizontal component of a floor 

15 reaction force moment about a desired ZMP without causing a 
floor reaction force vertical component and a floor 
reaction force horizontal component (strictly speaking, a 
translational floor reaction force vertical component and a 
translational floor reaction force horizontal component) to 

20 be perturbed. This motion mode is referred to as the body 
rotation mode. 

In other words, the motion for changing a 
horizontal component of a floor reaction force moment about 
a desired ZMP without causing a change in a floor reaction 

25 force vertical component and a floor reaction force 

horizontal component is referred to as the body rotation 
mode . 
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A change in the floor reaction force moment 
component per unit angular acceleration at that time is 
denoted by AMr and a change in the floor reaction force 
horizontal component per unit angular acceleration is 
5 denoted by AFr. AFr is zero. If an angular acceleration 

is applied such that the body inclines forward in the state 
shown in Fig. 6(b), then AMr acts in the direction of an 
arrow shown in Fig. 6(b) . 

The motions of the body 3 include a body vertical 

10 movement mode in addition to the body translation mode and 
the body rotation mode. This is a motion for moving the 
body 3 in the vertical direction. 

In the present embodiment, the simplified model 
gait generator 100c uses a simplified model and the 

15 processing of the gait parameter determiner 100a and the 
desired instantaneous value generator 100b uses a 
simplified model and a semi-full model. The following will 
explain these dynamic models. 

Fig. 7 shows an example of the structure of the 

20 simplified model. As illustrated, the simplified model is 
a model composed of a total of three mass points, namely, 
two mass points (foot mass points) 2m, 2m corresponding to 
the individual leg bodies 2 of the robot 1 and a mass point 
corresponding to the body 3 (body mass point) 24m, and a 

25 flywheel FH that has inertia but no mass. This simplified 
model is a dynamic model illustrated in, for example, PCT 
international publication WO/ 03/0 57 4 27 /Al previously 
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proposed by the present applicant. Hence, detailed 
explanation will be omitted in the present description. 
The dynamics of the simplified model is represented by 
expressions la to lc when variables are defined as follows. 
5 Here, for easy understanding of the present description, 
only the dynamic equations (kinetic equations) on a 
sagittal plane (plane including a longitudinal axis (X 
axis) and a vertical axis (Z axis) ) will be described, and 
the dynamic equations on a lateral plane (plane including a 
10 lateral axis (Y axis) and the vertical axis (Z axis) ) will 
be omitted. 

Zsup: Vertical position of supporting leg mass point; Zswg: 
Vertical position of free leg mass point; Zb: Vertical 
position of body mass point; ZGtotal: Vertical position of 

15 the total center-of -gravity ; Xsup: Horizontal position of 
supporting leg mass point; Xswg: Horizontal position of 
free leg mass point; Xb: Horizontal position of body mass 
point; XGtotal: Horizontal position of total center-of- 
gravity; Gby: Body posture angle about Y-axis relative to 

20 vertical direction (inclination angle) ; mb: Mass of body 

mass point; msup: Mass of supporting leg mass point; mswg: 
Mass of free leg mass point; mtotal: Total mass of robot 
(=mb+msup+mswg) ; J: Body inertial moment (Equivalent 
inertial moment in the body rotation mode) ; Fx: Floor 

25 reaction force horizontal component (specifically, a 
component in the longitudinal direction (X axis) of a 
translational floor reaction force); Fz : Floor reaction 
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force vertical component (specifically, a component in the 
vertical direction (Z axis) of a translational floor 
reaction force) ; My: Floor reaction force moment about a 
desired ZMP (specifically, a component about a lateral axis 
5 (Y axis) of a floor reaction force moment) ; and g: 

Gravitational acceleration. For an arbitrary variable X, 
d2X/dt2 means a second-order differential value of X. 

Fz=mb* (g+d2Zb/dt2) +msup* (g+d2Zsup/dt2 ) 

10 +mswg* (g+d2Zswg/dt2 ) Expression la 

Fx=mb*d2Xb/dt2+msup*d2Xsup/dt2+mswg*d2Xswg/dt2 

Expression lb 

My=-mb* (Xb-Xzmp) + (g+d2Zb/dt2 ) +mb* ( Zb-Zzmp) *d2Xb/dt2 
-msup* (Xsup-Xzmp) * ( g+d2Zsup/dt2 ) 
15 +msup* (Zsup-Zzmp) *d2Xsup/dt2 

-mswg* (Xswg-Xzmp) * (g+d2Zswg/dt2 ) 

+mswg* (Zswg-Zzmp) * (d2Xswg/dt2) +J*d20by/dt2 

Expression lc 

The following relational expression holds for the 
20 position of the total center-of -gravity of a robot: 
ZGtotal= (mb*Zb+msup*Zsup+mswg*Zswg) /mtotal 

...Expression Id 
XGtotal= (mb*Xb+msup*Xsup+mswg*Xswg) /mtotal 

...Expression le 

25 

The simplified model is constructed such that the 
dynamics of the leg bodies 2, 2 (the dynamics of the mass 
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points 2m, 2m) and the dynamics of the body 3 (the dynamics 
of the mass point 24m and the flywheel FH) do not interfere 
with each other, the dynamics of the entire robot 1 being 
expressed by the linear combinations thereof. Further, the 
5 relationship between the motions of the body 3 and floor 
reaction forces is divided into the relationship between 
translational motions of the body 3 (the body translation 
mode) and floor reaction forces and the relationship 
between rotational motions of the body 3 (the body rotation 

10 mode) and floor reaction forces. To be specific, a floor 

reaction force generated by a horizontal motion of the body 
mass point 24m corresponds to a floor reaction force 
generated by a horizontal translational motion of the body 
3 (the body translation mode) , and a floor reaction force 

15 generated by a rotational motion of the flywheel 

corresponds to a floor reaction force generated by a 
rotational motion of the body 3 (the body rotation mode) , 
that is, a posture changing motion of the body 3. 

The mass of the arm bodies of the robot 1 is 

20 included in the body mass point 24m, and the body mass 

point 24m has the mass that includes the mass of the arm 
bodies. In the present embodiment, as it will be discussed 
later, the motions of the arm bodies (arm swinging motion) 
in a desired gait are performed such that the relative 

25 position of the total center-of -gravity of both arm bodies 
in relation to the body 3 remains unchanged while canceling 
the moment of an inertial force about the vertical axis 
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that is generated in the robot 1 by a motion other than the 
arm swinging of the robot 1; therefore, the influences 
exerted on a floor reaction force moment and the influences 
exerted on a floor reaction force horizontal component by 
5 the arm swinging motions of the arm bodies (excluding a 
component about the vertical axis) are ignored. 

Fig. 8 illustrates a structure of a semi-full 
model. As shown in the figure, the semi-full model is a 
model that has corresponding mass points in the body 3, 

10 each foot 22, and in the portion near the knee joint of 

each leg body 2 (the portion adjacent to the knee joint of 
a thigh link) , respectively, the body 3 having an inertia 
(inertial moment) lb about the body mass point. In the 
semi-full model, the relationship between the motions of 

15 the robot 1 and floor reaction forces is described as the 
relationship between the translational motions of the mass 
points and the posture changing motions of the body 3 and 
floor reaction forces (the translational floor reaction 
forces and the floor reaction force moments about desired 

20 ZMPs) , as with the aforesaid simplified model, although the 
dynamic equations will be omitted. The semi-full model has 
dynamic accuracy that is higher than that of the aforesaid 
simplified model. To be more specific, the fact that the 
dynamic accuracy of the semi-full model is higher than that 

25 of the simplified model means that a floor reaction force 
generated on the semi-full model by an arbitrary desired 
motion of the robot 1 will agree more closely with an 
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actual floor reaction force that actually acts on the robot 
1 when the actual robot 1 carries out the desired motion on 
a supposed floor surface than a floor reaction force 
generated on the simplified model by the desired motion 
5 will. 

The full model used in the full-model corrector 
lOOd is a multi-mass-point model having a mass point in 
each link of the robot 1, as shown in, for example, Fig. 9. 
In this case, the each link of the robot 1 may have inertia 

10 about the mass point corresponding thereto. 

Supplementally, the semi-full model may have the 
same structure as that of the full model. 

Next, regarding the present embodiment, the 
processing of the gait producing device 100 will be 

15 explained in more detail. 

The gait producing device 100 in the present 
embodiment defines, as the unit, the desired gait (the 
desired gait in the aforesaid narrow sense) for the period 
of one step from the moment one leg body 2 of the robot 1 

20 lands to the moment the other leg body 2 lands, and 

generates desired gaits for the period of the one step in 
order. Here, the desired gait to be newly generated is 
referred to as "the current time's gait," the next desired 
gait is referred to as "the next time's gait," and the 

25 further next desired gait is referred to as "the next but 
one time's gait." Further, the desired gait generated 
immediately before "the current time's gait" is referred to 
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as "the last time's gait." 

When the gait producing device 100 newly generates 
a current time's gait, the expected landing 
positions/postures and the required values (requests) of 
5 the expected landing time of the foot 22 of a free leg of 
the robot 1 for two steps ahead are input as required 
parameters for the gait to the gait producing device 100 
(or the gait producing device 100 reads the required 
parameters from storage) . Based on these required 

10 parameters, the gait producing device 100 generates a 
corrected desired body position/posture trajectory, a 
desired foot position/posture trajectory, a desired ZMP 
trajectory, a desired floor reaction force vertical 
component trajectory, a desired arm posture trajectory, a 

15 corrected desired floor reaction force moment trajectory, 
and the like. 

The details of the gait generation processing of 
the gait producing device 100 will be given below with 
reference to Fig. 10 to Fig. 21. Fig. 10 is a flowchart 

20 (structured flowchart) showing the main routine of the gait 

generation processing executed by the gait producing device 
100. The procedure of the main routine processing itself 
is the same as that in, for example, the aforesaid PCT 
international publication WO/03/057427/A1 (hereinafter 

25 referred to as "publication document 1") by the present 

applicant except for subroutine processing, which is a part 
thereof . 
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First, in S010, various types of initializations 
are performed, including the initialization of time t to 
zero. This processing is performed when the gait producing 
device 100 is started up or the like. Subsequently, the 
5 procedure advances to S014 via S012, and the gait producing 
device 100 waits for a timer interrupt for each control 
cycle (the calculation processing cycle in the flowchart in 
Fig. 10) . The control cycle is denoted by At. 

Subsequently, the procedure proceeds to S016 

10 wherein it is determined whether the gait is changing, and 
if the gait is changing, then the procedure proceeds to 
S018, or if the gait is not changing, then the procedure 
proceeds to S030. Here, the aforesaid "the change of a 
gait" means the timing at which the generation of a current 

15 time' s gait is begun after the generation of the last 

time's gait has been completed. For example, a control 
cycle following the control cycle in which the generation 
of the last time's gait has been completed is the timing of 
a gait change . 

20 When the procedure proceeds to S018, time t is 

initialized to zero, then it proceeds to S020 wherein a 
next time's gait supporting leg coordinate system, a next 
but one gait supporting leg coordinate system, a current 
time's gait cycle, and a next time's gait cycle are read. 

25 These supporting leg coordinate systems and gait cycles are 
decided by the aforesaid required parameters. More 
specifically, in the present embodiment, the required 
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parameters supplied from a joystick 44 or the like to the 
gait producing device 100 include the required values of 
the expected landing positions/postures of the foot 22 of a 
free leg (the foot positions/postures in a state wherein, 
5 after landing, the foot 22 is rotated without a slippage 
such that substantially the entire sole thereof is in 
contact with a floor surface) for two steps ahead and 
expected landing time. The required value of the first 
step and the required value of the second step are supplied 

10 as the ones corresponding to the current time's gait and 

the next time current, respectively, to the gait producing 
device 100 before the generation of the current time's gait 
begins (at the gait change timing of the aforesaid S016) . 
Incidentally, these required values can be changed in the 

15 middle of the generation of the current time's gait. 

Then, the next time's gait supporting leg 
coordinate system is decided on the basis of the required 
values of the expected landing position/posture of the 
first-step foot 22 of the free leg (the foot 22 of the free 

20 leg in the current time's gait) in the aforesaid required 
parameters. Further, the next but one time's gait 
supporting leg coordinate system is decided on the basis of 
the required values of the expected landing 
positions/postures of the foot 22 of the second-step free 

25 leg. Further, the current time's gait cycle is defined as 
the time from the expected landing time (required value) of 
the foot 22 of the supporting leg of the current time's 
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gait to the expected landing time (required value) of the 
foot 22 of the free leg of the first step (the current 
time's gait), and the next time's gait cycle is defined as 
the time from the expected landing time (required value) of 
5 the first-step foot 22 of the free leg to the expected 

landing time (required value) of the second-step foot 22 of 
the free leg. 

The processing of S020 is the same as the 
processing of S020 of Fig. 13 in the aforesaid publication 

10 document 1, so that no further explanation will be given in 
the present description. 

Subsequently, the procedure proceeds to S022 
wherein the gait producing device 100 determines the gait 
parameter of a normal gait (normal gait parameter) as a 

15 virtual cyclic gait that follows the current time's gait. 
As the gait parameter determined here, there are a foot 
trajectory parameter that defines a desired foot 
position/posture trajectory in the normal gait, a reference 
body posture trajectory parameter that defines the body 

20 posture trajectory providing a reference, an arm posture 
trajectory parameter that defines a desired arm posture 
trajectory, a ZMP trajectory parameter that defines a 
desired ZMP trajectory, a floor reaction force vertical 
component trajectory parameter that defines a desired floor 

25 reaction force vertical component trajectory, and a 

parameter that defines a desired floor reaction force 
horizontal component permissible range. 



- 66 - 



The "normal gait" in the present description is 
used to mean a cyclic gait that does not develop 
discontinuity in the motion states (the states of foot 
position/posture, body position/posture, and the like) of 
5 the robot 1 at the boundaries of gaits when the gait is 

repeated. The "normal gait 7/ includes, of course, a cyclic 
gait for making the robot 1 advance straight and also 
includes a cyclic gait for making the robot 1 turn. In 
this case, setting the turning rate to zero means advancing 

10 straight; therefore, "turning" includes advancing straight 
in a broad sense. For this reason, the "normal gait" may 
be frequently referred to as "normal turning gait" in the 
embodiment in the present description. 

The normal turning gait is explained in detail in, 

15 for example, the aforesaid publication document 1 and 

Japanese Patent Application No. 2000-352011, so that no 
detailed explanation thereof in the present description 
will be omitted. The outline thereof is given below. 

In the present embodiment, the normal turning gait, 

20 which is a cyclic gait, is a gait for two steps of the 
robot 1. In other words, a gait composed of a first 
turning gait following the current time' s gait and a second 
turning gait following the first turning gait is defined as 
the gait for one cycle of the normal turning gait, and the 

25 gait for one cycle is repeated. If the current time's gait 
to be generated is, for example, a running gait for the 
robot 1 to run (a gait having a one-leg supporting period 
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and a floating period) , then the first turning gait and the 
second turning gait of the normal turning gait are also 
running gaits, while if it is a walking gait for the robot 
1 to walk (a gait having a one -leg supporting period and a 
5 two-leg supporting period) , then the first turning gait and 
the second turning gait of the normal turning gait are also 
running gait . This means that the basic gait mode of the 
first turning gait and the second turning gait are the same 
as that of the current time's gait. 

10 In the following explanation, unless otherwise 

specified, running gaits will be taken as examples of the 
gaits to be generated. 

Normal turning gaits are provisionally prepared to 
determine motion states of the robot 1, such as a 

15 divergence component, body vertical position/velocity, a 

body posture angle and the angular velocity thereof, at the 
terminating end of the current time's gait in the gait 
producing device 100, and they are not directly output from 
the gait producing device 100. 

20 Incidentally, "divergence" means that the position 

of the body 3 of the robot 1 is undesirably shifted to a 
position that is far apart from the positions of both feet 
22 and 22. The value of a divergence component is a 
numeric value that indicates how far the position of the 

25 body 3 of the robot 1 is apart from the positions of both 

feet 22 and 22 (more specifically, the origin of the global 
coordinate system (supporting leg coordinate system) set on 
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the ground contact surface of the foot 22 of a supporting 
leg) . For instance, in the embodiment in the present 
description, a divergence component relative to each 
dynamic model described above is determined by the 
5 following expression. 

Divergence component = Body mass point horizontal 
position + Body mass point horizontal velocity / <o0 
Expression 2 

10 

<o0 in this expression 2 denotes a predetermined 
value. In the present embodiment, a divergence component 
in a gait is determined using a body horizontal position 
and a body horizontal velocity in place of the body mass 

15 point horizontal position and the body mass point 
horizontal velocity in expression 2. 

In the embodiment in the present description, 
gaits (current time's gaits) are generated using divergence 
components as indicators such that desired gaits are 

20 continuously generated without causing the aforesaid 

divergence. More specifically, a current time's gait is 
generated such that a normal gait (more precisely, a normal 
gait parameter) following a current time's gait to be 
generated is set on the basis of the required parameters or 

25 the like related to the aforesaid current time's gait, an 
initial divergence component of the normal gait is 
determined, and then the terminal divergence component of 
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the current time's gait is made to agree with the initial 
divergence component of the normal gait (more generally, 
the current time's gait is made to continuously follow or 
approach the normal gait) . 
5 Returning to the main subject, in S022, a gait 

parameter of a normal gait (a parameter that defines a 
normal gait) is determined according to the flowchart of 
the subroutine processing shown in Fig. 11. More 
specifically, the foot trajectory parameter, the reference 

10 body posture trajectory parameter, the arm trajectory 

parameter, the ZMP trajectory parameter, the floor reaction 
force vertical component trajectory parameter, and the 
parameter defining the desired floor reaction force 
horizontal component permissible range related to the 

15 normal gait described above are individually determined by 
the processing of S100 to S110. Then, in S112, initial 
time Ts of the normal gait and a one-step period (the time 
for one cycle of the normal gait) Tcyc are redefined. The 
processing is the same as the processing of the flowchart 

20 of Fig. 15 in the aforesaid publication document 1, so that 
detailed explanation thereof will be omitted. The 
parameters of the normal gait determined in S100 to S110 
are the parameters that are determined such that the 
requirements related to the gait, which are represented 

25 primarily by the required parameters described above, are 
satisfied while the trajectories specified by the 
individual parameters satisfy the periodicity of the normal 



- 70 - 



gait at the same time. For example, as explained in 
conjunction with the flowchart of Fig. 15 in the aforesaid 
publication document 1, the foot trajectory parameter of 
the normal gait is determined such that the expected 
5 landing position/posture of the foot 22 of a free leg of 
the first turning gait following the current time's gait 
(the expected landing position/posture observed in the 
aforesaid next time's gait supporting leg coordinate 
system) agrees with the expected landing position/posture 

10 (required values) of the second step described above, and 

the expected landing position/posture of the foot 22 of the 
free leg of the second turning gait (the expected landing 
position/posture observed in the aforesaid next but one 
time's gait supporting leg coordinate system) agrees with 

15 the expected landing position/posture (required values) of 
the foot 22 of the free leg of the current time's gait. 
The ZMP trajectory parameter is determined on the basis of 
a foot trajectory parameter such that a desired ZMP is 
positioned substantially near the center of the ground 

20 contact surface of the foot 22 of a supporting leg and 

continuously changes over the entire period of the normal 
gait . 

The initial time Ts of the normal gait redefined 
in S112 of Fig. 13 means the time of the start point when 
25 creating gaits for one cycle of the normal gait, as will be 
described later (this differs fr om the time of the 
terminating end of the current time's gait in the present 
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embodiment) , and it is the time immediately before the 
start of the floating period (the timing when a desired 
floor reaction force vertical component becomes zero) of 
the first turning gait. Further, the one-step period Tcyc 
5 of the normal gait is the period of the total time of the 
first turning gait and the second turning gait of the 
normal gait. The normal gait is a gait whose state at 
arbitrary time Tx (the state of the position/posture of 
each portion of the robot 1 and the changing velocities 

10 thereof) becomes the same as the state at time Tx+Tcyc due 
to the periodicity thereof. The normal gait is a cyclic 
gait having the gait for two steps as one cycle; therefore, 
in the present description, the total time of the one-cycle 
period (the first turning gait and the second turning gait) 

15 is regarded as one-step period of the normal gait. 

Supplementally, the parameters of the normal gait 
determined by the processing of S100 to S110 are not all 
the parameters specifying the normal gait parameter. In 
the present embodiment, the gait parameter defining the 

20 normal gait (normal gait parameter) includes the position 
and velocity of the body 3 and the posture angle of the 
body 3 and the angular velocity thereof at the starting end 
(the start time of the period) or the terminating end (the 
end time of the period) of the one-cycle period of the 

25 normal gait and the peak value of a body inclination 
restoring moment ZMP-converted value, which will be 
discussed hereinafter, in addition to the parameters 
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determined in S022. Of these parameters, the horizontal 
position and horizontal velocity of the body 3, the angular 
velocity of a posture angle of the body 3, and the peak 
value of the body inclination restoring moment ZMP- 
5 converted value are determined in an exploratory manner by 
the processing of S024, which will be discussed later. The 
normal gait parameter is a gait parameter that allows a 
normal gait to be uniquely generated using the values of 
the parameters constituting the normal gait parameter and 

10 the aforesaid simplified model. 

Subsequently, the procedure proceeds to S024 
wherein the initial state of the normal gait is calculated. 
The initial state to be calculated here includes the 
initial body horizontal position/velocity (the initial body 

15 position and the initial body velocity in the horizontal 
direction) , the initial body vertical position/velocity 
(the initial body position and the initial body velocity in 
the vertical direction) , the initial divergence component, 
and the initial body posture angle and its angular velocity 

20 of the normal gait. The calculation of the initial state 
is performed using the simplified model and the semi-full 
model according to the flowchart of the subroutine 
processing of Fig. 12. 

The processing shown in Fig. 12 will be 

25 schematically explained. Taking the initial body 

horizontal position, the initial body horizontal velocity, 
the initial body posture angular velocity, and the body 
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inclination restoring moment ZMP-converted value peak value 
of the robot 1 at time Ts (the initial time of the normal 
gait) as search objects, and the initial state of the 
normal gait including these search objects is provisionally 
5 determined. From this initial state, gaits up to the 
terminating end of the normal gait (time Ts+Tcyc) are 
generated using dynamic models (the simplified model and 
the semi-full model) . Then, it is determined whether the 
generated normal gaits satisfy a boundary condition (the 

10 states at the initial end and the terminating end (the body 
horizontal position, the body horizontal velocity, the body 
posture angle, and the body posture angular velocity in the 
present embodiment) agree with each other) , and if they do 
not satisfy the boundary condition, then the values of the 

15 search objects are changed. This is repeated so as to 
eventually determine an initial state that allows the 
boundary condition to be satisfied. 

Supplementally, the basic concept (approach) of 
the processing shown in Fig. 12 is the same as the 

20 processing shown in Fig. 20 of the aforesaid publication 
document 1. However, in the embodiment of the present 
description, the search objects include a body posture 
angular velocity and the peak value of a body inclination 
restoring moment ZMP-converted value, which makes the 

25 embodiment different from the processing shown in Fig. 20 
of the publication document 1. In addition, a part of 
detailed processing (subroutine processing) of the 
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processing of S208 differs from that in the publication 
document 1 . 

A body inclination restoring moment ZMP- converted 
value peak value ZMPrecpeek determined in the processing of 
5 the flowchart shown in Fig. 12 indicates the peak value of 
a ZMP-converted value ZMPrec of a floor reaction force 
moment required for a body posture to approach a reference 
body posture (the amount of deviation from a desired ZMP 
providing a reference (a desired ZMP defined by a ZMP 

10 trajectory parameter determined in S022)) in a one-leg 

supporting period of the robot 1 (more specifically, the 
period from the moment immediately after the start of the 
one -leg supporting period to the moment immediately before 
the end thereof; hereinafter, it will be referred to as 

15 "the body inclination angle restoring period"), an example 
thereof being shown in Fig. 19. ZMPrec takes a trapezoidal 
pattern, as shown in the figure, the peak value thereof 
(the height of the trapezoid) being denoted by ZMPrecpeek. 
The following will specifically explain the 

20 processing shown in Fig. 12. First, in S200, foot 

position/posture, a body posture angle 0bs and the initial 
state of an arm posture (the state at initial time Ts of a 
normal turning gait) are determined on the basis of the 
normal gait parameter (the parameter determined in S022). 

25 Incidentally, these initial states are the states observed 
in the supporting leg coordinate system of a first turning 
gait (the aforesaid next time's gait supporting leg 
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coordinate system) . In this processing, the initial states 
of the foot position/posture are determined to be the 
positions/postures of the individual feet 22 at time Ts in 
the foot position/posture trajectories calculated using a 
5 finite-duration setting filter on the basis of the foot 
trajectory parameters determined in the aforesaid S022. 
The finite-duration setting filter is explained in the 
aforesaid publication document 1 and the like, so that an 
explanation thereof will be omitted. Furthermore, the 

10 initial state of the body posture angle 6bs is determined 

to be the same as a reference body posture angle at time Ts 
determined on the basis of the reference body posture 
trajectory parameter determined in S022, and the initial 
state of an arm posture is determined to be the same as the 

15 state at time Ts determined on the basis of the arm posture 
trajectory parameters determined in S022. 

Subsequently, in S202, an initial (time Ts) body 
horizontal position, an initial body horizontal velocity, 
an initial body posture angular velocity, and the peak 

20 value of a body inclination restoring moment ZMP-converted 
value on the simplified model are taken as search objects, 
and the candidates (Xs, Vx, cobs, ZMPrecpeek) of these 
search objects are provisionally determined (the initial 
values of candidate values of the search objects are 

25 determined). In this case, the provisionally determined 
candidate values may be basically arbitrary, and they may 
be determined on the basis of, for example, the initial 
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states of a normal gait determined when the last time's 
gait was generated. Incidentally, these values 
provisionally determined are the values observed in the 
supporting leg coordinate system of the first turning gait 
5 (the aforesaid next time's gait supporting leg coordinate 
system) . 

Subsequently, the loop processing of S206 to S218 
is carried out. To schematically explain the processing, a 
gait from the starting end (time Ts) to the terminating end 

10 (time Ts+Tcyc) of a normal gait is generated using the 

normal gait parameter including the search objects 
provisionally determined as described above and the 
simplified model. Then, it is determined whether the 
generated normal gait satisfies the boundary condition (the 

15 condition in that the states (a body horizontal position, a 
body horizontal velocity, a body posture angle, and a body 
posture angular velocity in the present embodiment) at the 
beginning end and the terminating end substantially agree 
with each other) , and if it does not satisfy the boundary 

20 condition, then the values of the search objects are 

changed. This is repeated so as to finally determine the 
initial states of the normal gait that can satisfy the 
boundary condition of the normal gait on the simplified 
model . 

25 The following will explain the processing of S206 

to S218 more specifically. In S206, the body vertical 
position and the body vertical velocity (Zs, Vzs) at the 
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beginning (time Ts ) of a normal gait on the simplified 
model are determined. In this case, they are determined 
such that the resultant force of the inertial force in the 
vertical direction of the total center-of -gravity of the 
5 robot 1 and gravity on the simplified model balances out a 
desired floor reaction force vertical component, and the 
vertical position of the total center-of -gravity satisfies 
the boundary condition of the normal gait. This processing 
is carried out in the same manner as that of the processing 

10 of S206 shown in Fig. 20 in the aforesaid publication 

document 1. Incidentally, (Zs, Vzs) depend upon the values 
(candidate values) of Xsl, Vxsl, 0bsl, and cosl determined 
or provisionally determined as described above. 

Subsequently, in S208, a gait (a provisional 

15 normal gait) is generated using the simplified model up to 
the time Ts+Tcyc (the terminating end of the normal gait) 
on the basis of the normal gait parameter that includes the 
candidate values of current search objects, the vertical 
position and the vertical velocity of the body 3, and 

20 ZMPrecpeek. This processing will be described hereinafter. 

Subsequently, in S210, the body horizontal 
position, the body horizontal velocity, and the body 
posture angle and its angular velocity at the terminating 
end of the gait generated in S208 are converted into the 

25 values observed from the supporting leg coordinate system 
of the next one step of the gait (the supporting leg 
coordinate system of the first turning gait following the 
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second turning gait of the normal gait generated in S208), 
and the obtained values are denoted by (Xe, Vxe, 6be, cobe) . 

Then, in S212, the differences between the values 
of the current (Xs, Vxs , 0bs, cobs) and the values of (Xel, 
5 Vxel, 6bel, cobel) are determined as boundary condition 
errors (errx, errv, err0, errco) of the normal gait (the 
provisional normal gait generated in S208). To satisfy the 
boundary condition of the normal gait , the boundary 
condition errors must be substantially zero. The boundary 

10 condition errors indicate the degree of deviation of the 
gait created in S208 from the boundary condition. 

Subsequently, in S214, it is determined whether 
all of errx, errv, err9, and errco fall within a 
sufficiently small (in the vicinity of zero) predetermined 

15 permissible range, and if the determination result is YES, 
then the procedure terminates the loop processing of S206 
to S218 and proceeds to S220. In this case, it means that 
the gait generated in S208 satisfies the boundary condition 
of a normal gait, so that the gait will be an original 

20 normal gait to be in connection with the current time's 
gait . 

Meanwhile, if the determination result of S214 is 
NO, then the candidates of a plurality of (four in the 
present embodiment) search objects obtained by changing the 
25 values of Xs, Vx, cobs, and ZMPrecpeek by predetermined 
extremely small amounts AXs , AVx, Acobs, and AZMPrecpeek 
are determined in the vicinity of the candidate values of 
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the current search objects (Xs, Vx, cobs , ZMPrecpeek) , and 
the same processing as that of S2088 to S212 is carried out 
to determine the boundary condition errors corresponding to 
the candidates of the individual search objects on the 
5 basis of the normal gait parameter that includes the 

candidates of the individual search objects (the normal 
gait parameter having the search objects of the normal gait 
parameter corrected to the newly determined candidates). 

Subsequently, in S218, the new candidates of the 

10 search objects (Xs # Vx, cobs, ZMPrecpeek) are determined by 
an exploratory technique, such as the steepest descent 
method or the simplex method, on the basis of the current 
(Xs, Vx, cobs, ZMPrecpeek) and the boundary condition 
errors corresponding to the individual candidates of the 

15 search objects in the vicinity thereof. Then, the 
processing from S206 is repeated again. 

In S220 after completing the loop processing of 
S206 to S218, on the basis of the normal gait lastly 
generated in S208 of the loop processing (the gait that 

20 satisfies the boundary condition of the normal gait), an 
initial body horizontal position X0, an initial body 
horizontal velocity VxO, an initial body posture angle 9b0 
and an angular velocity thereof cobO , an initial body 
vertical position Z0, and an initial body vertical velocity 

25 VzO, which indicate a motion state of the body 3 of the 

normal gait at an original initial time 0 (the terminating 
time of the current time's gait), are determined. Further, 
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in S222, according to the definitional expression of the 
initial divergence component q mentioned above, a normal 
turning initial divergence component q[0], which is a 
divergence component of the normal turning gait at the 
5 original initial time 0, is determined. The value 

determined in S222 is the value observed in the supporting 
leg coordinate system of the first turning gait of the 
normal turning gait that follows the current time's gait. 
Then, in S224, q" , which denotes the value indicating the 

10 normal turning initial divergence component q[0] observed 
from the supporting leg coordinate system of the current 
time's gait, and (Z0" ,VzO" ) , which denote the initial (time 
0) body vertical position and velocity observed from the 
supporting leg coordinate system of the current time's gait, 

1 5 are de t ermined . 

As described above, the values of (Xs, Vx, cobs, 
ZMPrecpeek) , which are the search objects, are determined 
such that the boundary condition of the normal gait is 
satisfied, and the values of the search objects are used to 

20 determine the initial state (including an initial 

divergence component), which is a state (the motion state 
of the body 3) at the original initial time (time 0) . 

The processing of S208 in the processing shown in 
Fig. 12, the explanation of which has been deferred, is 

25 carried out by the subroutine processing shown by the 

flowchart of Fig. 13, and the processing of S306 and S322 
of this Fig. 13 is carried out by the subroutine processing 
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shown by the flowchart of Fig. 14. Further, the processing 
of S412 of Fig. 14 is carried out by the subroutine 
processing shown by the flowchart of Fig. 15. These 
processing will be explained below. 
5 The processing shown in Fig. 13 will be 

schematically explained. First, the processing of S300 to 
S310 provisionally creates a normal gait such that a 
desired ZMP is satisified on a simplified model and a floor 
reaction force component permissible range is satisfied at 

10 each time k (the time at every predetermined time width Ak) 
from the initial time Ts to the terminating time Ts+Tcyc of 
the normal gait. At this time, a time series of a floor 
reaction force moment error Merr_p(k) as an error of a 
floor reaction force moment horizontal component about a 

15 desired ZMP generated on a simplified model by a motion of 
the provisionally created gait (provisional motion) and a 
times series of a translational floor reaction force error 
Ferr_p(k) as an error of a translational floor reaction 
force horizontal component generated on the simplified 

20 model by the motion are determined. The processing shown 
in Fig. 13 includes processing for not only creating a 
normal gait but also for determining these errors Merr_p(k) 
and Ferr_p ( k) . 

Here, the floor reaction force moment error 

25 Merr_jp(k) is determined, at each time k of a gait 

provisionally created using a simplified model, as the 
difference between a floor reaction force moment horizontal 
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component about a desired ZMP generated on a semi-full 
model by a motion of the gait and a floor reaction force 
moment horizontal component generated by the motion on the 
simplified model or a desired value thereof (=0) . Further , 
5 the translational floor reaction force error Ferrjp(k) is 

determined, at each time k of a provisionally created gait, 
as the difference between a translational floor reaction 
force horizontal component generated on a semi-full model 
by a motion of the gait and a translational floor reaction 

10 force horizontal component generated by the motion on the 
simplified model. 

Subsequently, the processing of S318 to S324 
creates a normal gait by correcting a motion of the 
aforesaid provisionally created gait by using errors 

15 Merr_p(k) and Ferr_p(k) . At this time, at each time k from 
the starting end to the terminating end of the normal gait, 
the moment obtained by adding a floor reaction force moment 
error Merr_p(k) to a floor reaction force moment about a 
desired ZMP generated on a simplified model by a motion of 

20 the gait (the normal gait to be created) is regarded as a 

true floor reaction force moment about the desired ZMP, and 
the normal gait is created such that the true floor 
reaction force moment becomes zero (such that the original 
definition of the desired ZMP is satisfied) . At the same 

25 time, at each time k from the starting end to the 

terminating end of the normal gait, the moment obtained by 
adding a translational floor reaction force error Ferr_p(k) 
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to a translational floor reaction force horizontal 
component generated on a simplified model by a motion of 
the gait (the normal gait to be created) is regarded as a 
true translational floor reaction force horizontal 
5 component, and the normal gait is created such that the 

true floor reaction force horizontal component satisfies a 
floor reaction force horizontal component permissible range. 
In this case, a floor reaction force generated on a semi- 
full model is used as a true value of a floor reaction 

10 force that provides the reference of the errors Merr_p(k) 

and Ferr_p(k). Supplementally, creating a gait such that a 
moment obtained by adding a floor reaction force moment 
error Merr_p(k) to a floor reaction force moment about a 
desired ZMP generated on a simplified model becomes zero is 

15 equivalent to creating a gait such that the floor reaction 
force moment horizontal component (=-Merr_p ( k) ) obtained by 
subtracting the floor reaction force moment error Merr_p(k) 
from an original desired value (=0) of a floor reaction 
force moment horizontal component about a desired ZMP is 

20 generated about the desired ZMP on a simplified model. 

The following will specifically explain the 
processing of Fig. 13. First, in S300, as the initial 
state (the state at time Ts) of a motion of the body 3, 
values (current candidate values) (Xs, Vxs, 0bs, cos, Zs, 

25 Vzs) provisionally determined in the processing of Fig. 12 
are set. 

Subsequently, in S302, each value of the time 
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series of the floor reaction force moment error Merr_p(k) 
and the translational floor reaction force error Ferr_p(k) 
is initialized to zero. The Merr_p(k) and Ferr_p(k) are 
initialized to zero here to create a gait that satisfies a 
5 desired ZMP on a simplified model and to satisfy a floor 
reaction force horizontal component permissible range in 
S306 to be discussed later. 

Via S304 following the aforesaid S302, the 
processing of S306 to S310 is implemented at each time from 

10 the initial time Ts to the terminating time Ts+Tcyc of the 
normal gait. In S306, using the time series of the error 
Merr_p(k) and Ferr_p(k) initialized in S302, a time series 
of an instantaneous value of a normal gait is created such 
that -Merr_p(k) is generated about a desired ZMP (a desired 

15 ZMP defined by a ZMP trajectory parameter determined in 

S022) at time k on a simplified model and a value obtained 
by adding Ferr_p(k) to a translational floor reaction force 
horizontal component (a translational floor reaction force 
that balances out an inertial force involved in a 

20 translational acceleration horizontal component of a total 
center-of -gravity of a gait on the simplified model) falls 
within a floor reaction force horizontal component 
permissible range (the floor reaction force horizontal 
component permissible range defined by the parameters 

25 determined in S022) at time k. In this case, Merr_p(k)=0 
and Ferr_p(k)=0 in S306, so that a gait created 
(provisionally created) in S306 will eventually be a gait 
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that satisfies a desired ZMP on the simplified model and 
also satisfies the floor reaction force horizontal 
component permissible range. More specific processing of 
S306 will be described later. During the processing of 
5 S306, at each time k, a difference Merr(k) between a floor 
reaction force moment horizontal component about a desired 
ZMP generated on a semi-full model by a motion of a gait 
that is being provisionally created and a floor reaction 
force moment horizontal component about a desired ZMP 

10 generated on the semi-full model by the motion is 
determined, and a difference Ferr(k) between a 
translational floor reaction force horizontal component 
generated on the semi-full model by the motion and a 
translational floor reaction force horizontal component 

15 generated on the simplified model by the motion is 
determined . 

Subsequently, in S308, the Merr(k) and the Ferr(k) 
determined as described above are set as new values of 
Merr_p(k) and Ferrjp(k), respectively. Further, time k is 

20 updated to k+Ak in S310. The processing of S306 to S310 
described above is repeated until k=Ts+Tcyc. This 
provisionally creates the time series of instantaneous 
value of a gait that satisfies a desired ZMP on the 
simplified model and also satisfies the floor reaction 

25 force horizontal component permissible range, and time 

series of Merr_p(k) and Ferr_p(k) corresponding thereto are 
determined. The Merr_p(k) and Ferr_p(k) determined as 
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described above indicate errors of a floor reaction force 
generated on the simplified model by a motion (provisional 
motion) of a normal gait created in S306. 

Subsequently, in S318, the initial state of the 
5 body 3 is set in the same manner as that in S300. Further, 
via S320, the processing of S322 and S324 is carried out at 
each time from the initial time Ts to the terminating time 
Ts+Tcyc of the normal gait. The processing of these S322 
and S324 is the same as the processing of the aforesaid 

10 S306 and S310, respectively. However, in the processing of 
S322, the time series of Merr_p(k) and Ferr_p(k) used in 
the processing is not the value (=0) initialized in the 
aforesaid S302, but it is the latest time series, that is, 
the time series of Merr_p(k) and Ferr_p(k) determined in 

15 the aforesaid S308 (these are generally non-zero) . 

This completes the processing of Fig. 13, and the 
normal gait created by the processing of S320 to S324 is 
obtained as the normal gait to be created in S208 of Fig. 
12. 

20 The processing of S306 and S322 of Fig. 13 (the 

processing for creating the time series of instantaneous 
values of the normal gait) is implemented by the subroutine 
processing shown by the flowchart of Fig. 14. 

In this processing of Fig. 14, first, the 

25 processing of S400 to S410 determines the instantaneous 

values of a desired floor reaction force vertical component, 
a desired ZMP, desired positions/postures of both feet, a 
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reference body posture, a desired arm posture, a desired 
body vertical position, and a floor reaction force 
horizontal component permissible range on the basis of the 
parameters of the normal gait determined in the aforesaid 
5 S022. This processing of S400 to S410 is the same as the 
processing of S400 to S410 of Fig. 22 in the aforesaid 
publication document 1, so that detailed explanation will 
be omitted here. 

Subsequently, the instantaneous values of a body 

10 horizontal acceleration and a body posture angular 

acceleration are determined by the processing of S412 such 
that the conditions described in the figure are satisfied. 
In this case, if Merr_p(k) is regarded as the error of a 
floor reaction force moment horizontal component about a 

15 desired ZMP generated on a simplified model at time k by a 
motion of a gait that is being created, then it is 
considered that determining the motion of the gait such 
that -Merr_p(k) is generated about a desired ZMP (the 
desired ZMP determined in S402) on the simplified model 

20 causes a true floor reaction force moment horizontal 

component about the desired ZMP generated by the actual 
robot 1 by the determined motion (strictly speaking, the 
floor reaction force moment horizontal component about a 
desired ZMP generated on the semi-full model) to become 

25 substantially zero (an original desired value of the floor 
reaction force moment horizontal component about the 
desired ZMP) . Hence, in S412, the body horizontal 
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acceleration and the body posture angular acceleration are 
determined such that -Merr_p(k) is produced about the 
desired ZMP on the simplified model. Incidentally, this is 
equivalent to determining the body horizontal acceleration 
5 and the body posture angular acceleration such that the 
result obtained by adding the error Merr_p(k) to a floor 
reaction force moment horizontal component about the 
desired ZMP generated on the simplified model by the motion 
of the gait to be created («-Merr_p ( k) ) becomes zero, which 

10 is the original desired value of the floor reaction force 
moment horizontal component about the desired ZMP. 

Further, if Ferr_p(k) is regarded as the error of 
a translational floor reaction force horizontal component 
generated on a simplified model at time k by a motion of a 

15 gait that is being created, then it is considered that 
determining the motion of the gait such that the result 
obtained by adding Ferr_p(k) to the translational floor 
reaction force horizontal component produced by the motion 
of the gait on the simplified model does not exceed the 

20 floor reaction force horizontal component permissible range 
(the permissible range determined in S410) on the 
simplified model causes a translational floor reaction 
force horizontal component acting on the actual robot 1 by 
the determined motion (strictly speaking, the translational 

25 floor reaction force horizontal component generated on the 
semi-full model) to fall within the floor reaction force 
horizontal component permissible range. Hence, in S412, 
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the body horizontal acceleration and the body posture 
angular acceleration are determined such that the result 
obtained by adding Ferr_p(k) to the translational floor 
reaction force horizontal component produced on the 
5 simplified model by the motion of the gait to be created 
does not exceed the floor reaction force horizontal 
component permissible range (the permissible range at 
current time k determined in S410) . 

More specific description of the processing of 

10 S412 will be given later. 

Subsequently, by the processing of S414, the body 
horizontal acceleration and the body posture angular 
acceleration determined in S412 as described above are 
subjected to second-order integration to determine 

15 instantaneous values of the body horizontal position and 
the body posture angle. By this time, the instantaneous 
values of the body vertical position, the foot 
position/posture, and the arm posture have already been 
determined (refer to S404 and S408), meaning that the 

20 instantaneous value of the motion of the robot 1 (the 

instantaneous value of the desired motion of the normal 
gait) composed of the aforesaid instantaneous values and 
the instantaneous values of the body horizontal position 
and the body posture angle have been determined. 

25 Supplementally, each of the leg bodies 2 of the robot 1 of 
the present embodiment has six degrees of freedom; 
therefore, once the instantaneous value of the desired 
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position/posture of each foot 22 and the instantaneous 
value of the desired position/posture of the body 3 are 
determined, the displacement amount of each joint of each 
leg body 2 of the robot 1 is uniquely determined. 
5 Further, the processing of S415 following S414 

calculates a floor reaction force moment horizontal 
component Msmpl(k) about the desired ZMP and a 
translational floor reaction force horizontal component 
Fsmpl(k) at time k (current time) generated on the 

10 simplified model by the desired motion of the normal gait 
determined as described above. 

In this case, the floor reaction force moment 
horizontal component Msmpl(k) about the desired ZMP and the 
translational floor reaction force horizontal component 

15 Fsmpl(k) may be calculated by using the simplified model on 
the basis of the determined desired motion composed of the 
foot position/posture, the body position and velocity, and 
the body posture angle and angular velocity. In other 
words, the Msmpl(k) is calculated as the value with a 

20 reversed sign of the instantaneous value (the value at each 
time k) of the horizontal component of the moment generated 
about the desired ZMP by the resultant force of each 
inertial force produced by a motion of each element (the 
mass points and the flywheel in the present embodiment) of 

25 the simplified model and the gravity acting on the total 
center-of -gravity of the simplified model, which is 
determined in association with the desired motion. Further, 
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the Fsmpl(k) is calculated as the value with a reversed 
sign of the value (the horizontal component of an inertial 
force produced by a motion of the total center-of -gravity ) 
obtained by multiplying the instantaneous value (the value 
5 at each time k) of the horizontal component of the 

translational acceleration of the total center-of -gravity 
of the simplified model in association with the desired 
motion by the total mass of the simplified model. 

Alternatively, the Msmpl(k) and the Fsmpl(k) may 
10 be determined according to the following expressions 

instead of performing the calculation of the simplified 
model as described above. 

Msmpl (k) =0-Merrjp (k) Expression 3a 

15 Fsmpl (k) =Fx' (k) -Ferr_p (k) Expression 3b 

More specifically, the gait created by the 
processing from S410 to S414 is created such that - 
Merr_p(k) is generated about a desired ZMP (more precisely, 

20 the value obtained by subtracting Merr_p(k) from an 

original desired floor reaction force moment horizontal 
component (=0) about the desired ZMP), so that the floor 
reaction force moment Msmpl (k) about the desired ZMP 
generated on the simplified model by a motion of the gait 

25 agrees or substantially agrees with -Merr_p(k). Hence, 
Msmpl (k) may be determined according to the aforesaid 
expression 3a. Incidentally, "0" in expression 3a may be 
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of course omitted. 

Further, Fx' (k) in expression 3b is obtained by 
adding a translational floor reaction force error (a 
translational floor reaction force horizontal component 
5 error) Ferr_p(k) to the translational floor reaction force 
horizontal component Fsmpl(k) produced on the simplified 
model by a motion of a gait created by the processing from 
S410 to S414, and it is determined such that it satisfies a 
floor reaction force horizontal component permissible range 

10 in the processing of S412 to be discussed later (more 

specifically, it is determined as the desired value (the 
desired value that satisfies a floor reaction force 
horizontal component permissible range) of a floor reaction 
force horizontal component ( Fsmpl ( k) +Ferr_p ( k) ) when a body 

15 horizontal acceleration is determined) . Thus, the 

translational floor reaction force horizontal component 
Fsmpl(k) produced on the simplified model by a motion of 
the gait created by the processing from S410 to S414 agrees 
or substantially agrees with the value of the right side of 

20 expression 3b, so that Fsmpl(k) may be determined according 
to expression 3b by using the value of Fx' (k) determined in 
the processing of S412. 

The Msmpl(k) and Fsmpl(k) may be determined using 
expression 3a and expression 3b as described above. The 

25 same applies to the processing for creating a current 

time's gait, which will be described later (the processing 
of S028 or the processing of S032 to be described later) . 
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Subsequently, the processing of S416 following 
S415 calculates an instantaneous value Msemif ull ( k) of a 
floor reaction force moment horizontal component about a 
desired ZMP and an instantaneous value Fsemif ull (k) of a 
5 translational floor reaction force horizontal component 

generated on the aforesaid semi-full model on the basis of 
the desired motion of the gait determined as described 
above. The method for the calculation is the same as that 
for calculating the instantaneous values Msmpl(k) and 

10 Fsmpl(k) on the simplified model in the aforesaid S415. In 
this case, however, the Msemif ull ( k) and Fsemif ull ( k) 
cannot be determined by the same technique as the aforesaid 
expressions 3a and 3b, so that actual calculation 
processing of the semi-full model need to be carried out. 

15 These Msemif ull ( k) and Fsemif ull ( k) correspond to the true 
values of a floor reaction force moment horizontal 
component and a translational floor reaction force 
horizontal component, respectively, acting on the robot 1 
when a motion of the actual robot 1 is performed on the 

20 basis of a desired motion. 

Subsequently, in the processing of S418, new floor 
reaction force moment error Merr(k) and translational floor 
reaction force error Ferr(k) are calculated according to 
the following expressions 3c and 3d. 

25 



Merr ( k) =Msemif ull ( k) -Msmpl ( k) 
Expression 3c 
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Ferr (k) =Fsemifull (k) -Fsmpl (k) 

Expression 3d 

Supplementally, it is unnecessary to perform the 
5 processing of S415 to S418 of Fig. 14 during the processing 
of S322 of Fig. 13. In the present embodiment, the 
subroutine processing of S306 and S322 of Fig. 13 is the 
same; hence, the processing of S415 to S418 is carried out 
in both S306 and S322. If the subroutine processing of 

10 S306 and S322 is to be separately constructed, then an 
algorithm may be constructed on the assumption that 
Merr_p(k)=0 and Ferr_p(k)=0 from the beginning in the 
processing of S306, and in such a case, the processing of 
S302 of Fig. 13 is unnecessary. Further, in this case, the 

15 processing of S415 to S418 may be deleted from the 
beginning in the processing of S322. Further, when 
applying the aforesaid expression 3a in S415 in the 
processing of S306, Msmpl(k) is always zero, so that the 
processing of S415 may be omitted in the processing of S322. 

20 The same supplemental particular explained above applies to 
the processing for creating a current time's gait to be 
discussed later (the processing of S028 to be discussed 
later) . 

The subroutine processing of S412 of Fig. 14 is 
25 carried out as shown by the flowchart of Fig. 15. 

In the processing of Fig. 15, first, times Tm, Ts2, 
and Tm2 that define a body inclination angle restoring 
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period of a normal gait are determined. These times define 
the period during which the aforesaid body inclination 
restoring moment ZMP-converted value ZMPrec is generated, 
as shown in Fig. 19. More specifically, the time 
5 immediately following the start of a first one-leg 

supporting period after the initial time Ts of a normal 
gait is determined as Tm, the time immediately following 
the end of the one-leg supporting period is determined as 
Ts2, and the time immediately following the start of the 

10 next one-leg supporting period is determined as Tm2 . And, 
a period [Tm, Ts2] and a period [Tm2, Te] are respectively 
defined as the periods during which ZMPrec is generated 
(the body inclination angle restoring period in a normal 
gait) . This is the same as the processing of S500 of Fig. 

15 23 in the aforesaid publication document 1. 

Subsequently, in S502, it is determined whether 
the current time k at which an instantaneous value of a 
normal gait is to be created (the time in the normal gait 
that is being created) is in the body inclination angle 

20 restoring period. And, if the current time k is not time 
within the aforesaid body inclination angle restoring 
period, that is, if the current time k is in a period from 
an instant immediately before the end of a one-leg 
supporting period to an instant immediately after the start 

25 of the next one-leg supporting period (a period during 

which a desired floor reaction force vertical component is 
zero or in the vicinity of zero) , then the processing of 
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S504 to S518 is carried out- In these processing, first, a 
body horizontal acceleration atmp attributable to a motion 
of the aforesaid body translational mode is calculated such 
that a floor reaction force moment horizontal component - 
5 Merr_p(k) obtained by subtracting a current value Merr_p(k) 
of a floor reaction force moment error (a floor reaction 
force moment horizontal component error) from an original 
desired floor reaction force moment horizontal component 
(=0) about a desired ZMP is generated on a simplified model 

10 (S504). atmp denotes a provisional value of a body 

horizontal acceleration in a gait that is being created. 
Then, a translational floor reaction force horizontal 
component Fxtmp' obtained by adding a current value 
Ferr_p(k) of a translational floor reaction force error (a 

15 translational floor reaction force horizontal component 

error) to a translational floor reaction force horizontal 
component Fxtmp that balances out an inertial force 
attributable to a horizontal acceleration of the total 
center-of -gravity of the simplified model 

20 (=Fxtmp+Ferr__p(k) ) when the body horizontal acceleration is 
denoted by atmp is compared with a floor reaction force 
horizontal component permissible range (S506 to S510). If 
this comparison reveals that Fxtmp' deviates from the floor 
reaction force component permissible range, then a 

25 translational floor reaction force horizontal component Fx' 
to be generated by a motion of the gait that is being 
created (this Fx' means a desired value of the component 
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obtained by adding Ferr p(k) to a translational floor 
reaction force horizontal component generated on the 
simplified model by the motion of the gait that is being 
created) is restricted to an upper limit value Fxmax or a 
5 lower limit value Fxmin of the floor reaction force 

horizontal component permissible range, or if Fxtmp' falls 
within the floor reaction force component permissible range, 
then Fxtmp is directly determined as Fx r (S512 to S514). 

Then, a body horizontal acceleration a of the 

10 aforesaid body translational mode is determined such that a 
translational floor reaction force horizontal component 
obtained by adding the current value Ferr p(k) of a 
translational floor reaction force error (a translational 
floor reaction force horizontal component error) to a 

15 translational floor reaction force horizontal component Fx 
generated on the simplified model by a motion of a gait 
that is being created ( =Fx+Ferr_p(k) ) agrees with the Fx' 
determined as described above, and a body angular velocity 
P of the body rotation mode is determined such that a floor 

20 reaction force moment horizontal component about a desired 
ZMP becomes -Merr p(k) on the simplified model by a motion 
of the body translational mode of the body horizontal 
acceleration a and a motion of the body rotation mode 
(S518) . 

25 Thus, the body horizontal acceleration a of the 

body translational mode and the body angular acceleration p 
of the body rotation mode are determined such that - 
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Merr_p(k) is generated about the desired ZMP on the 
simplified model (the value obtained by adding the current 
value Merr(k) of a floor reaction force moment error to a 
floor reaction force moment horizontal component generated 
5 about the desired ZMP on the simplified model by a motion 
of the gait that is being created becomes zero, which is 
the original desired value about the desired ZMP) , and the 
translational floor reaction force horizontal component Fx 7 
obtained by adding the current value Ferr_p(k) of a 

10 translational floor reaction force error to the floor 

reaction force horizontal component Fx that balances out an 
inertial force attributable to a horizontal acceleration of 
the total center-of-gravity (this corresponds to a 
translational floor reaction force horizontal component 

15 truly generated by the motion of the gait that is being 
created) on the simplified model falls within a floor 
reaction force horizontal component permissible range. 

Further, if the current time k (time within a 
normal gait that is being created) is time within the 

20 aforesaid body inclination angle restoring period, then the 
processing of S520 to S530 is carried out. In these 
processing, first, the body angular acceleration p is 
determined such that a floor reaction force moment based on 
an instantaneous value of a body inclination restoring 

25 moment ZMP-converted value pattern (this is determined on 
the basis of a body inclination restoring moment ZMP- 
converted value peak value (a latest candidate value) 
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provisionally determined during the processing of the 
aforesaid S12 and the current time k. Refer to Fig. 19) is 
generated about a desired ZMP on the simplified model (S520 
and S522) . Further, the body horizontal acceleration a is 
5 determined as a difference between the body horizontal 

acceleration atmp for a floor reaction force moment about 
a desired ZMP generated by a motion of a body translational 
mode on the simplified model to agree with a floor reaction 
force moment horizontal component -Merr_p(k) obtained by 

10 subtracting the current value Merr_p(k) of a floor reaction 
force moment error from an original desired floor reaction 
force moment horizontal component (=0) and a body 
horizontal acceleration that generates a floor reaction 
force moment equivalent to a floor reaction force moment by 

15 the body angular acceleration (3 previously determined (S524 
and S526) . 

Thus, the body angular acceleration |3 and the body 
horizontal acceleration a are determined such that - 
Merr_p(k) is generated about a desired ZMP while restoring 

20 the body posture toward a reference body posture on the 

simplified model. At the same time, if the body horizontal 
acceleration is the acceleration a determined as described 
above, then the translational floor reaction force 
horizontal component Fx' obtained by adding the current 

25 value Ferr_p(k) of a translational floor reaction force 

error to the floor reaction force horizontal component Fx 
that balances out an inertial force attributable to a 
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horizontal acceleration of a total center-of -gravity on the 
simplified model is determined as a translational floor 
reaction force horizontal component truly generated by a 
motion of a gait that is being created. If the current 
5 time k is time within the aforesaid body inclination angle 
restoring period, then a floor reaction force horizontal 
component permissible range is sufficiently wide, so that 
the translational floor reaction force horizontal component 
Fx' determined as described above will not deviate from the 

10 permissible range. For this reason. Fx' is not compared 
with a floor reaction force horizontal component 
permissible range in the processing of SS520 to S530. 

Supplementally, the basic concept (approach) of 
the processing shown in Fig. 15 is the same as the 

15 processing shown in Fig. 22 of the aforesaid publication 

document 1. However, in the processing in the publication 
document 1, a body horizontal acceleration and a body 
posture angular acceleration are determined such that they 
satisfy a desired ZMP (a floor reaction force moment 

20 horizontal component about the desired ZMP becomes zero) on 
the simplified model and also satisfy a floor reaction 
force horizontal component permissible range on the 
simplified model. In comparison with this, the processing 
shown in Fig. 15 of the present embodiment determines a 

25 body horizontal acceleration and a body posture angular 
acceleration such that the floor reaction force moment 
horizontal component -Merr_p(k) obtained by subtracting the 
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current value Merr_p(k) of a floor reaction force moment 
error from an original desired floor reaction force moment 
horizontal component (=0) about a desired ZMP is produced 
on the simplified model (in other words, the value obtained 
5 by adding the current value Merr_p(k) of a floor reaction 
force moment error to a floor reaction force moment 
horizontal component produced about the desired ZMP by a 
motion of the robot 1 on the simplified model becomes zero, 
which indicates an original desired floor reaction force 

10 moment horizontal component about the desired ZMP) , and the 
translational floor reaction force horizontal component Fx' 
obtained by adding the current value Ferr_p(k) of a 
translational floor reaction force error to the floor 
reaction force horizontal component Fx that balances out an 

15 inertial force attributable to a horizontal acceleration of 
a total center-of-gravity satisfies a floor reaction force 
horizontal component permissible range (falls within the 
permissible range) on the simplified model. 

In the present embodiment, it has been arranged 

20 such that the translational floor reaction force horizontal 
component Fx' obtained by adding the current value 
Ferr_p(k) of a translational floor reaction force error to 
the floor reaction force horizontal component Fx that 
balances out an inertial force attributable to a horizontal 

25 acceleration of a total center-of-gravity satisfies a floor 
reaction force horizontal component permissible range 
(falls within the permissible range) on the simplified 
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model. Alternatively, however, a body horizontal 
acceleration and a body posture angular acceleration may be 
determined such that Fx satisfies a permissible range 
obtained by subtracting the current value Ferr_p(k) of a 
5 translational floor reaction force error from the upper 

limit value and the lower limit value, respectively, of a 
floor reaction force horizontal component permissible range. 
This is equivalent to the original method. 

In the present embodiment, a normal gait is 

10 generated as described above, so that the normal gait 

lastly generated in S024 is determined such that a floor 
reaction force produced on a semi-full model by the motion 
thereof (this accurately agrees with a floor reaction force 
acting on the actual robot 1 attributable to the motion) 

15 satisfies a desired ZMP and a floor reaction force 

horizontal component permissible range. At this time, the 
normal gait is generated on the basis of the dynamics of a 
simplified model with high linearity, taking into account 
the error Merr_p(k) and Ferr_p(k) of a floor reaction force 

20 produced on the simplified model in response to a motion of 
the gait. Further, an instantaneous value of the normal 
gait at each time k is generated by adding a correction 
based on Merrjp(k) and Ferr_p(k) at that time. This makes 
it possible to promptly and efficiently determine the 

25 initial state of the normal gait in an exploratory manner 
without causing a motion of the gait to diverge. In 
addition, the semi-full model is used only to calculate a 
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floor reaction force (a floor reaction force horizontal 
component and a translational floor reaction force 
horizontal component) produced by a motion of a gait 
created using the simplified model; therefore, the 
5 calculation does not require exploratory processing or the 
like and it can be accomplished promptly and easily. 

Returning to the explanation of Fig. 10, after the 
processing of S024 is carried out as explained above, gait 
parameters of a current time's gait is determined (some are 

10 provisionally determined) in S026. This processing is 
carried out according to the flowchart of Fig. 16. The 
gait parameters determined here include the parameters that 
define a foot position/posture trajectory (the 
position/posture trajectory of each foot 22) , a reference 

15 body posture trajectory, an arm posture trajectory, a floor 
reaction force vertical component trajectory, a floor 
reaction force horizontal component permissible range, and 
a ZMP trajectory in the current time's gait, and these 
individual parameters are determined by the processing from 

20 S600 to S610. Then, in S612, a body inclination angle 

restoring period [Ta, Tb] in the current time's gait is set. 
This processing is the same as the processing of a 
flowchart of Fig. 33 in the aforesaid publication document 
1, so that detailed explanation will be omitted here, but 

25 the gait parameters defining the individual trajectories 
are determined such that the aforesaid trajectories are 
connected from the terminal states of a last time's gait 
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(the initial states of a current time's gait) to a normal 
gait while satisfying the aforesaid requirements related to 
the current time's gait. For example, the foot trajectory 
parameter related to the foot 22 of a free leg of the 
5 current time's gait is determined such that the expected 
landing position/posture and time of the foot 22 of the 
free leg of the current time's gait satisfy the required 
values thereof and the position/posture of the foot 22 of 
the free leg at the end of the current time's gait agree at 

10 the beginning of a normal gait (at the time of the end of 
the current time's gait). 

Supplementally, the ZMP trajectory parameter 
determined in S610 is a provisional value, an example of 
the ZMP trajectory defined by the provisional value (an 

15 example of the trajectory in the X-axis direction) being 

shown at the top in Fig. 21. The ZMP trajectory parameter 
is determined such that a desired ZMP is positioned near 
substantially the center of the ground contact surface of 
the foot 22 of a supporting leg in the one-leg supporting 

20 period of the current time's gait and that the desired ZMP 
continuously changes until the initial ZMP of the normal 
gait at the end of the current time's gait in a floating 
period following the one-leg supporting period. Further, 
the body inclination angle restoring period set in S612 of 

25 Fig. 16 is the period from time Ta to time Tb in Fig. 21 
and it is the period from the point immediately after the 
start of the one-leg supporting period of the current 
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time's gait to the point immediately before the end thereof. 

The parameters of the current time's gait 
determined by the processing from S600 to S610 are not all 
the parameters constituting a current time's gait parameter. 
5 In the present embodiment, the gait parameter defining the 
current time's gait (the current time's gait parameter) 
includes, in addition to the parameters determined in S02 6, 
a ZMP correcting parameter for correcting a ZMP trajectory 
defined by a ZMP trajectory parameter and a peak value of a 

10 body inclination restoring moment ZMP-converted value (two 
types of peak values in this case) . These parameters are 
determined in the exploratory manner in the processing of 
S028 explained below. 

Subsequently, the procedure proceeds to S028 

15 wherein the gait parameter (the ZMP trajectory parameter) 
of the current time's gait is corrected. In this 
processing, the gait parameter of the current time's gait 
is corrected such that the divergence component at the end 
of the current time's gait agrees with the initial 

20 divergence component of the normal turning gait determined 
in S024 (more specifically, such that a body 
position/posture trajectory is connected to or brought 
close to a normal gait) , thereby determining a final 
current time's gait parameter (more specifically, 

25 determining a ZMP correcting parameter and two types of 
peak values of a body inclination restoring moment ZMP- 
converted value) . 
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This processing is carried out according to the 
subroutine processing shown by the flowchart of Fig. 17. 

The processing shown in Fig. 17 will be 
schematically explained. A ZMP correcting parameter "a", 
5 which is the parameter defining a ZMP correction amount, 

and a first peak value ZMPrecpeeka and a second peak value 
ZMPrecpeekb of the body inclination restoring moment ZMP- 
converted value are determined in the exploratory manner 
such that the terminal divergence component of the current 

10 time's gait agrees or substantially agrees with the initial 
divergence component of a normal gait (such that the 
current time's gait connects to the normal gait) on the 
simplified model. Here, the first peak value ZMPrecpeeka 
and a second peak value ZMPrecpeekb of the body inclination 

15 restoring moment ZMP -converted value determined in the 

processing of Fig. 17 indicate two peak values of a pattern 
of a ZMP -converted value of a floor reaction force moment 
required to bring a body posture close to a reference body 
posture in the body inclination angle restoring period [Ta, 

20 Tb] of the current time's gait, an example thereof being 

shown in Fig. 20. There has been only one peak value of a 
body inclination restoring moment ZMP-converted value in 
the case of a normal gait ; in the present embodiment , 
however, the first peak value ZMPrecpeeka and the second 

25 peak value ZMPrecpeekb are used as two adjustable 

parameters of the body inclination restoring moment ZMP- 
converted value in order to make the body posture angle and 
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the angular velocity thereof at the end of the current 
time's gait agree with the initial body posture angle and 
the angular velocity thereof, respectively, of a normal 
gait. In the present embodiment, as shown in Fig. 20, the 
5 body inclination restoring moment ZMP- converted value in 
the current time's gait takes a pattern having a shape 
combining a trapezoidal pattern in the first half of a one- 
leg supporting period and another trapezoidal pattern in 
the latter half thereof, the peak value of the trapezoidal 

10 pattern of the first half being the first peak value 

ZMPrecpeeka and the peak value of the trapezoidal pattern 
of the latter half being the second peak value ZMPrecpeekb. 

Further, the ZMP correcting parameter "a" 
determined in the processing of Fig. 17 is a parameter 

15 defining the correction amount of a desired ZMP for 

connecting the current time's gait to the normal gait (for 
making the terminal divergence component of the current 
time's gait substantially agree with the initial divergence 
component q" of the normal gait), an example thereof being 

20 shown at the middle in Fig. 21. As illustrated, the ZMP 
correction amount defined by the ZMP correcting parameter 
"a" has a trapezoidal pattern produced from a point 
immediately after the start of a one -leg supporting period 
to a point immediately before the end thereof, and the peak 

25 value "a" is used as the ZMP correcting parameter. 

The processing of Fig. 17 will be explained in 
more detail. First, in S700, the initial candidates of the 
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values of "a", ZMPrecpeeka and ZMPrecpeekb, which are 
search objects, on the simplified model are provisionally 
determined. In this case, the initial candidates may be 
basically arbitrary or they may be determined, for example, 
5 on the basis of the values of "a", ZMPrecpeeka and 

ZMPrecpeekb or the like that have been finally determined 
when creating a last time's gait. 

Subsequently, the loop processing of S704 to S714 
is carried out. The processing will be schematically 

10 explained. First, in S704, a current time's gait 

(provisional current time's gait) is calculated using the 
current candidate values of "a", ZMPrecpeeka, and 
ZMPrecpeekb, which are search objects, and the simplified 
model. More specifically, the provisional current time's 

15 gait is calculated using a current time's gait parameter 
composed of a ZMP trajectory parameter that has been 
corrected on the basis of the current value of the ZMP 
correcting parameter "a", the current values of ZMPrecpeeka 
and ZMPrecpeekb, and parameters other than the ZMP 

20 trajectory parameter determined in S026 (a foot trajectory 
parameter, a floor reaction force vertical component 
trajectory parameter, etc.), and the simplified model. 
More specific processing of S704 will be discussed 
hereinafter. 

25 Then, in S706 to S716, the difference between the 

divergence component at the terminating end of the 
provisional current time's gait calculated in S704 (the 



- 109 - 



time at which the foot of a free leg of the current time's 
gait is expected to land) and the initial divergence 
component q" of a normal gait (the component finally 
calculated in the aforesaid S024), the difference between 
5 the body posture angle at the terminating end of the 
provisional current time's gait and the initial body 
posture angle of the normal gait (the posture angle finally 
calculated in the aforesaid S024), and the difference 
between the angular velocity of the body posture angle at 

10 the terminating end of the provisional current time's gait 
and the initial posture angular velocity of the normal gait 
(the angular velocity finally calculated in the aforesaid 
in the aforesaid S024) are determined. Then, it is 
determined whether all the values of these differences 

15 satisfy a condition in that they fall within permissible 
ranges (whether they are in the vicinity of zero), and if 
they do not satisfy the condition, then the values of the 
search objects are changed. This is repeated to eventually 
determine "a", ZMPrecpeeka and ZMPrecpeekb as the corrected 

20 values of a gait parameter that allows the provisional 

current time's gait to connect to the normal gait on the 
simplified model. 

The processing of S706 to S716 will be explained 
in more detail. In S706, a terminal divergence component 

25 q0[k] of the provisional current time's gait is calculated 
according to the aforesaid definitional expression of 
divergence components from body position and velocity (Xe, 
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Ve) at the terminating end of the provisional current 
time' s gait . 

Subsequently, in S708, the difference between the 
terminal divergence component q0[k] and the initial 
5 divergence component q" of a normal turning gait is 

determined as a terminal divergence component error errq. 

Further, in S710, the difference between the 
initial body posture angle of the normal gait and the 
terminal body posture angle of the provisional current 
10 time's gait created in S704 is determined as a terminal 

body posture angle error 0berr, and the difference between 
the initial body posture angular velocity of the normal 
gait and the terminal body posture angular velocity of the 
provisional current time's gait created in S704 is 
15 determined as a terminal body posture angular velocity 
error coberr. 

The errors errq, 0berr, and coberr determined as 
described above indicate a degree of deviation of the 
provisional current time's gait created in S704 from a 

20 boundary condition (a condition in that the current time's 
gait connects, at its terminating end, to the normal gait) . 

Subsequently, in S712, it is determined whether 
all of the errq, 0berr, and oberr determined as described 
above fall within predetermined permissible ranges in the 

25 vicinity of zero, and the determination result is YES, then 
the loop processing of S704 to S716 is terminated. In this 
case, a current time's gait parameter that includes current 
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candidate values of search objects is obtained as the 
current time's gait parameter that makes it possible to 
generate a gait connecting to a normal gait on the 
simplified model. 
5 Meanwhile, if the determination result in S712 is 

NO, then the candidates of a plurality of (three in the 
present embodiment) search objects obtained by changing the 
values of the individual parameters by predetermined 
extremely small amounts Aa, AZMPrecpeeka, and AZMPrecpeekb 

10 are determined in the vicinity of the candidate values of 

the current search objects ("a", ZMPrecpeeka, ZMPrecpeekb ) , 
and the same processing as that of S704 to S710 is carried 
out on the basis of the current time's gait parameters, 
which include the candidates of the individual search 

15 objects, to determine a set of errors (errq, 0berr, coberr) 
associated with each search object candidate. 

Subsequently, in S716, the new candidates of the 
search objects ("a", ZMPrecpeeka, ZMPrecpeekb) are 
determined by an exploratory technique, such as the 

20 steepest descent method or the simplex method, on the basis 
of the current candidates of the search objects ("a", 
ZMPrecpeeka, ZMPrecpeekb) and the sets of errors (errq, 
0berr, coberr) associated with the candidates of the search 
objects in the vicinity thereof. Then, the processing from 

25 S704 is repeated again. 

As described above, the current time's gait 
parameter is determined in the exploratory manner such that 
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a current time's gait connects to a normal gait, ("a", 
ZMPrecpeeka, ZMPrecpeekb) being the search objects. 

The processing of S704 in the processing of Fig. 
17 is implemented by the subroutine processing shown by the 
5 flowchart of Fig. 18. 

This processing of Fig. 18 is the processing for 
determining a floor reaction force moment error about a 
desired ZMP and a translational floor reaction force error 
and for sequentially creating, in time series, the 

10 instantaneous value of a current time's gait (provisional 
current time's gait) from the start to the end thereof, as 
with the aforesaid processing of Fig. 13 related to the 
creation of a normal gait. In this case, the difference 
from the processing for generating a normal gait in Fig. 13 

15 is only the initial state of the gait and the gait 

generation period. More specifically, regarding this 
different aspect, in the processing of Fig. 18, the 
terminal state of a last time's gait (specifically, the 
terminal state of the current time's gait observed in the 

20 supporting leg coordinate system) is set as the initial 

state of the current time's gait (the provisional current 
time's gait) in S800 and S818. Further, the period during 
which the processing of S804 to S810 and the processing of 
S820 to S824 are carried out is the period from start time 

25 (k=0) of the current time's gait to end time Tcurr (the 
time at which the foot 22 of a free leg of the current 
time's gait is expected to land) of the current time's gait 
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(refer to S804 and S820) . The processing other than this 
is the same as the processing of Fig. 13. In this case, 
the processing of S800 to S810 corresponds to the 
processing of S300 to S310 of Fig. 13, and the processing 
5 of S818 to S824 corresponds to the processing of S318 to 

S324 of Fig. 13. Thus, the processing of S806 and S822 of 
Fig. 18 is implemented by the aforesaid subroutine 
processing of Fig. 14, and the processing of S412 of Fig. 
14 is implemented by the subroutine processing of Fig. 15. 

10 However, in the processing of S806 and S822 of Fig. 18, the 
processing of S500 is omitted in the processing of Fig. 15, 
which is the subroutine processing of S412 of Fig. 14. 
This is because the body inclination angle restoring period 
of the current time's gait is the period [Ta, Tb] set in 

15 S612 of Fig. 16. 

In the present embodiment, the provisional current 
time's gait is generated in S028 as explained above. In 
this case, as in the case of creating a normal gait, the 
processing of S800 to S810 of Fig. 18 provisionally creates 

20 the current time's gait such that a desired ZMP (a desired 
ZMP obtained by correcting the desired ZMP defined by a ZMP 
trajectory parameter determined in S026 by a ZMP correcting 
parameter "a" provisionally determined in the processing of 
Fig. 17 (the latest candidate value) ) is satisfied and that 

25 a floor reaction force horizontal component permissible 
range (the permissible range defined by the parameters 
determined in S026) is satisfied on the simplified model 
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from the start to the end of the current time's gait. Then, 
based on a motion (provisional motion) of the provisionally 
created gait, the time series of the floor reaction force 
moment error (floor reaction force moment horizontal 
5 component error) Merr_p(k) and the translational floor 
reaction force error Ferr_j?(k) are determined using the 
simplified model and the semi-full model. Furthermore, the 
processing of S818 to S824 of Fig. 18 creates the time 
series of instantaneous values of the provisional current 

10 time's gait such that a floor reaction force moment 

horizontal component produced about the aforesaid desired 
ZMP on the simplified model becomes -Merr_p(k) (the value 
obtained by adding the current value Merr(k) of a floor 
reaction force moment error to a floor reaction force 

15 moment horizontal component generated about the desired ZMP 
on the simplified model by a motion of a gait that is being 
created becomes zero, which is the original desired value 
about the desired ZMP) and that the value obtained by 
adding Ferr_p(k) to a translational floor reaction force 

20 horizontal component generated on the simplified model 

falls within a floor reaction force horizontal component 
permissible range related to the current time' s gait at 
each time k of the current time's gait. 

Accordingly, the provisional current time's gait 

25 lastly generated in S028 will be a gait that connects to a 
normal gait (satisfy the boundary condition of the current 
time's gait) while satisfying a desired ZMP and a floor 
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reaction force horizontal component permissible range on a 
semi-full model. At this time, the provisional current 
time's gait is generated on the basis of the dynamics of 
the simplified model, taking into account the error 
5 Merr p(k) and Ferr p(k) of a floor reaction force on the 
simplified model. Further, an instantaneous value of the 
current time ' s gait at each time k is generated by adding a 
correction based on Merr_p(k) and Ferr_p(k) at that time. 
This makes it possible to promptly and efficiently 

10 determine the gait parameters ("a", ZMPrecpeeka, and 

ZMPrecpeekb) of the current time's gait in an exploratory 
manner without causing a motion of the gait to diverge. 

Returning to the explanation of Fig. 10, after the 
processing of S028 is carried out as explained above, the 

15 procedure proceeds to SO 30 wherein the parameters defining 
a ZMP permissible range and a floor reaction force 
horizontal component permissible range for full-model 
correction are determined. 

This processing is the same as the processing of 

20 S030 of Fig. 13 in the aforesaid publication document 1, so 
that the explanation thereof will be omitted herein. 

The processing up to S018 to S030 explained above 
is the processing carried out by the aforesaid gait 
parameter determiner 100a. Supplementally, the time series 

25 of Merr p(k) related to the provisional current time's gait 
lastly generated in S028 is the aforesaid floor reaction 
force moment error trajectory (refer to Fig. 5) and the 
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time series' of Ferr_p(k) related to the provisional current 
time's gait is the aforesaid translational floor reaction 
force error trajectory (refer to Fig. 5) . 

After the processing of S030 is carried out or if 
5 the determination result of S016 is NO, then the procedure 
proceeds to S032 wherein an instantaneous value of the 
current time's gait is sequentially determined. The 
subroutine processing of this processing is the same as the 
aforesaid processing of the flowchart shown in Fig. 14. 

10 However, in this case, the values lastly determined in S028 
of Fig. 10 described above are used as the values of the 
time series of Merr_p(k) and Ferr_p(k) used in S412. The 
processing of S416 and S418 is omitted. The time width 
(the value of the aforesaid Ak) of the time series of the 

15 instantaneous values of the current time's gait is defined 
as the control cycle At of the control unit 60. 

Subsequently, the procedure proceeds to S034 
wherein the operations of the arm bodies to cancel a spin 
(the rotation about a vertical axis) of the robot 1 is 

20 determined. This processing is for determining the 

postures of the arm bodies such that a floor reaction force 
moment in the opposite direction from the vertical 
component of the floor reaction force moment, which would 
be generated about a desired ZMP if the robot 1 were 

25 operated according to a desired gait without swinging the 
arms of the robot 1, is generated by the arm swings of the 
arm bodies (a motion of swinging both arm back and forth in 
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the opposite directions from each other) . This is 
performed in the same manner as that in S034 of Fig. 13 in 
the aforesaid publication document 1. The details thereof 
are described in the publication document 1, so that no 
5 further explanation will be given herein. 

Supplementally , the processing of S412 and S414 in 
S032 and the processing of S034 are the processing carried 
out by the aforesaid simplified model gait generator 100c. 
Subsequently, the procedure proceeds to S036 

10 wherein the instantaneous value of the ZMP permissible 
range and the instantaneous value of the floor reaction 
force horizontal component permissible range for full-model 
correction (for the processing of the aforesaid full-model 
corrector lOOe) are determined. In this processing, they 

15 are determined on the basis of the gait parameters that 
define the ZMP permissible range and the floor reaction 
force horizontal component permissible range determined in 
S030 described above. 

Supplementally, the processing of S032 to S036 

20 (excluding the processing of S412 and S414 in S032 and the 

processing of S034) is the processing carried out by the 
aforesaid desired instantaneous value generator 100b. 

Subsequently, the procedure proceeds to S038 
wherein a corrected gait using the full-model is generated. 

25 This processing is the processing carried out by the 

aforesaid full-model corrector 100c. In this case, the 
processing is the same as the processing of S038 of Fig. 13 
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in the aforesaid publication document 1, and it is carried 
out exactly as described in the publication document 1. 
Hence, detailed explanation will be omitted in the present 
description. This processing determines corrected desired 
5 body position/posture obtained by further correcting 

desired body position/posture (the body position/posture of 
the aforesaid displacement-dimension corrected gait) and a 
corrected desired floor reaction force moment. 

The above is the gait generation processing of the 
10 gait producing device 100 in the present embodiment. 

Here, the correspondence relationship between the 
gait generation processing of the gait producing device 100 
in the present embodiment and the present invention will be 
explained. 

15 In the present embodiment, the normal gait lastly 

generated in the processing of S024 in Fig. 10 corresponds 
to the desired gait in the first invention or the second 
invention described above. In this case, in association 
with the final normal gait, the motion of the normal gait 

20 created by the processing of S300 to S310 of Fig. 13 in the 
processing of S024 corresponds to the provisional motion in 
the first or the second invention, and the processing of 
S300 to S310 corresponds to the provisional motion creating 
means in the first invention or the second invention 

25 described above. And, the processing of S318 to S324 of 
Fig. 13 corresponds to the provisional motion correcting 
means in the first invention or the second invention. More 
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specifically, in S415 of Fig. 14 in the processing of S322, 
the embodiment in which the floor reaction force moment 
horizontal component Msmpl(k) about a desired ZMP generated 
on the simplified model by a desired motion is actually 
5 calculated by the computation of the simplified model 

corresponds to the first invention, while the embodiment in 
which the aforesaid expression 3a is used to determine the 
Msmpl(k) corresponds to the second invention. 

Similarly, the current time's gait lastly 

10 generated by the processing of S028 of Fig. 109 or the 
current time's gait generated by the processing of S032 
corresponds to the desired gait in the first invention or 
the second invention described above. In this case, in 
association with the final normal gait, the motion of the 

15 normal gait created by the processing of S800 to S810 of 
Fig. 18 in the processing of S028 corresponds to the 
provisional motion in the first or the second invention, 
and the processing of S800 to S810 corresponds to the 
provisional motion creating means in the first invention or 

20 the second invention described above. And, the processing 
of S818 to S824 of Fig. 18 corresponds to the provisional 
motion correcting means in the first invention or the 
second invention. More specifically, in S415 of Fig. 14 in 
the processing of S822, the embodiment in which the floor 

25 reaction force moment horizontal component Msmpl(k) about a 
desired ZMP generated on the simplified model by a desired 
motion is actually calculated by the computation of the 
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simplified model corresponds to the first invention, while 
the embodiment in which the aforesaid expression 3a is used 
to determine the Msmpl(k) corresponds to the second 
invention . 

5 The operation of the composite-compliance control 

unit 101 will now be explained with reference to Fig. 4. 
Incidentally, the operation of the composite-compliance 
control unit 101 is described in detail in Japanese 
Unexamined Patent Application Publication No. H10-277969 

10 and the like previously applied by the present applicant; 

therefore, only schematic explanation will be given in the 
present description. In the gait producing device 100, the 
corrected desired body position/posture (trajectory) and 
the desired arm posture (trajectory) out of the desired 

15 gait generated as described above are sent out to a robot 
geometric model (inverse kinematics calculator) 102. 

Further, the desired foot position/posture 
(trajectory) , the desired ZMP trajectory (the desired total 
floor reaction force central point trajectory) , and the 

20 desired total floor reaction force (trajectory) (the 

corrected desired floor reaction force moment and the 
desired floor reaction force vertical component) are sent 
to a composite-compliance operation determiner 104 and also 
to a desired floor reaction force distributor 106. Then, 

25 in the desired floor reaction force distributor 106, the 

floor reaction force is distributed to each foot 22 and the 
desired floor reaction force central point of each foot and 
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the desired floor reaction force of each foot are 
determined. The determined desired floor reaction force 
central point of each foot and the desired floor reaction 
force of each foot are sent to the composite-compliance 
5 operation determiner 104. 

Corrected desired foot position/posture 
(trajectory) with deformation compensation is sent from the 
composite-compliance operation determiner 104 to the robot 
geometric model 102. Upon receipt of the desired body 

10 position/posture (trajectory) and the corrected desired 
foot position/posture (trajectory) with deformation 
compensation, the robot geometric model 102 calculates the 
joint displacement commands (values) of the twelve joints 
of the leg bodies 2, 2 that satisfy them and sends them to 

15 a displacement controller 108. The displacement controller 
108 carries out follow-up control of the displacements of 
the twelve joints of the robot 1, using the joint 
displacement commands (values) calculated by the robot 
geometric model 102 as the desired values. Further, the 

20 robot geometric model 102 calculates the displacement 

commands (values) of arm joints that satisfy desired arm 
postures and sends them to the displacement controller 108. 
The displacement controller 108 carries out follow-up 
control of the displacements of the twelve joints of the 

25 arm bodies of the robot 1, using the joint displacement 

commands (values) calculated by the robot geometric model 
102 as the desired values. 
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The floor reaction forces (specifically, the 
actual floor reaction force of each foot) generated in the 
robot 1 are detected by the six-axis force sensor 50. The 
detected values are sent to the aforesaid composite- 
5 compliance operation determiner 104. Further, the posture 
inclination errors Gerrx and Berry (specifically, the 
errors of actual posture angles relative to the desired 
body posture angle, the posture angle error in the roll 
direction (about the X-axis) being denoted by 0errx and the 

10 posture angle error in the pitch direction (about the Y- 

axis) being denoted by Gerry) generated in the robot 1 are 
detected through the intermediary of the posture sensor 54, 
and the detected values are sent to a posture stabilization 
control calculator 112. The posture stabilization control 

15 calculator 112 calculates the compensating total floor 
reaction force moment about the desired total floor 
reaction force central point (the desired ZMP) for 
restoring the body posture angle of the robot 1 to the 
desired body posture angle and the calculation result is 

20 sent to the composite-compliance operation determiner 104. 

The composite-compliance operation determiner 104 corrects 
the desired floor reaction force on the basis of the input 
value. To be specific, the desired floor reaction force is 
corrected such that the compensating total floor reaction 

25 force moment or the sum of the compensating total floor 
reaction force moment and the corrected desired floor 
reaction force moment acts about the desired total floor 
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The composite-compliance operation determiner 104 
determines the aforesaid corrected desired foot 
position/posture (trajectory) with deformation compensation 
5 so as to make the states of the actual robot and the floor 
reaction force calculated from sensor-detected values and 
the like coincide with the desired floor reaction force 
that has been corrected. In this case, the corrected 
desired foot position/posture with deformation compensation 

10 considers the mechanical deformation of the aforesaid 
compliance mechanism 72 or the like. However, it is 
virtually impossible to make all states agree with desired 
values, so that a trade-off relationship is imparted among 
them to make them compromisingly agree as much as possible. 

15 More specifically, a control error for each desired value 
is weighted in conducting control so that the weighted 
average of the control error (or the square of the control 
error) is minimized. Thus, actual foot position/posture 
and total floor reaction force are controlled so as to 

20 approximately follow the desired foot position/posture and 
the desired total floor reaction force. 

Several modifications of the embodiment explained 
above will now be explained. The modifications explained 
below are applicable to cases where either normal gaits or 

25 current time's gaits are generated. 

In the embodiment described above, the body 
acceleration and the body posture angular acceleration have 



- 124 - 



been determined (and the desired gait (the normal gait or 
the current time's gait) has eventually been determined) 
such that the floor reaction force moment about the desired 
ZMP becomes the floor reaction force moment horizontal 
5 component -Merr_p(k) obtained by subtracting the current 
value Merr_p(k) of the floor reaction force moment error 
from the original desired floor reaction force moment 
horizontal component (=0) at each time k from the start to 
the end of the gait (the normal gait or the current time's 

10 gait) . Alternatively, however, the body acceleration and 
the body posture angular acceleration may be determined, 
taking the floor reaction force moment horizontal component 
obtained by subtracting the value acquired by multiplying 
the current value Merr_p(k) of the floor reaction force 

15 moment error by a predetermined coefficient (e.g., a 

positive number of 1 or less) from a desired floor reaction 
force moment horizontal component as the desired value of a 
floor reaction force moment about a desired ZMP on the 
simplified model. This means that the body acceleration 

20 and the body posture angular acceleration are determined 
such that the floor reaction force moment horizontal 
component acquired by adding the value obtained by 
multiplying the current value Merr__p(k) of the floor 
reaction force moment error by a predetermined coefficient 

25 (e.g., a positive number of 1 or less) (this corresponding 

to a first floor reaction force correction amount in the 
present invention) to the floor reaction force moment 
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horizontal component produced about the desired ZMP on the 
simplified model by a motion of a gait (desired gait) that 
includes the body acceleration and the body posture angular 
acceleration to be determined agrees with the original 
5 desired floor reaction force moment horizontal component. 
Thus, a motion of a gait may be determined such that the 
floor reaction force moment horizontal component obtained 
by adding the floor reaction force correction amount 
determined on the basis of Merr_p(k) to the floor reaction 

10 force moment horizontal component generated about the 

desired ZMP on the simplified model by a motion of a gait 
(desired gait) that includes the body acceleration and the 
body posture angular acceleration to be determined agrees 
with the original desired floor reaction force moment 

15 horizontal component. The aforesaid floor reaction force 

correction amount may be determined from Merr_p(k) by using 
a monotone increasing nonlinear function. 

Based on the same concept, the body acceleration 
and the body posture angular acceleration may be determined 

20 such that the translational floor reaction force horizontal 
component acquired by adding the value obtained by 
multiplying the current value Ferr_p(k) of the 
translational floor reaction force error by a predetermined 
coefficient (e.g., a positive number of 1 or less) (this 

25 corresponding to a second floor reaction force correction 
amount in the present invention) to the floor reaction 
force horizontal component Fx balancing out an inertial 
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force attributable to a horizontal acceleration of the 
total center-of-gravity (the horizontal acceleration of the 
total center-of-gravity attributable to the motion of a 
gait (desired gait) that includes the body horizontal 
5 acceleration and the body posture angular acceleration to 
be determined) on the simplified model satisfies a floor 
reaction force horizontal component permissible range. 
Thus, a motion of a gait may be determined such that the 
translational floor reaction force horizontal component 

10 obtained by adding the floor reaction force correction 

amount determined on the basis of Ferr_p(k) to the floor 
reaction force horizontal component Fx balancing out an 
inertial force attributable to a motion of a gait (desired 
gait) that includes the body horizontal acceleration and 

15 the body posture angular acceleration to be determined 
satisfies a floor reaction force horizontal component 
permissible range. Incidentally , the aforesaid floor 
reaction force correction amount may be determined from 
Ferr_jp(k) by using a monotone increasing nonlinear function. 

20 Further, after completion of the processing of 

S300 to S310 in Fig. 13, it is determined, before carrying 
out the processing of S318 to S324 in Fig. 13, whether the 
time series of the errors Merrjp(k) and Ferr_p(k) 
determined by the processing of S304 to S310 take values 

25 that are sufficiently close to zero, and the processing of 
S318 to S324 may be omitted, depending upon the 
determination result. More specifically, if the 
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determination result is YES , it means that the dynamic 
accuracy of a floor reaction force produced on the 
simplified model by a motion of a gait generated by the 
processing of S304 to S310 is adequately secured (the floor 
5 reaction force approximates a true value) . In such a case, 
therefore, the processing of S318 to S324 may be omitted 
and the gait generated by the processing of S304 to S310 
may be defined as the desired gait to be lastly obtained by 
the processing shown in Fig. 13. The same applies to the 

10 processing shown in Fig. 18 for creating a current time's 
gait. Determining whether the time series of the errors 
Merr__p(k) and Ferr_p(k) respectively take values 
approximating zero can be of course accomplished by 
determining whether the values of the time series of 

15 Merr_p(k) and Ferr_p(k) fall within permissible ranges in 
the vicinity of zero; alternatively, however, it may be 
determined whether a particular characterizing amount of 
the time series pattern of each of Merr_p(k) and 
Ferr_p(k) (e.g., the maximum value of an absolute value of 

20 each value of the times series or the effective value of 
the absolute value, or the difference between a maximum 
value and a minimum value of the time series pattern) falls 
within a permissible range in the vicinity of zero. 

Further, in the aforesaid embodiment, the error 

25 Merr_p(k) related to the floor reaction force moment 

horizontal component about the desired ZMP has been used; 
alternatively, however, a point of action different from 
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the point of a desired ZMP may be set, and an error 
(denoted by Merrj?' (k) here) related to a floor reaction 
force moment horizontal component about the point of action 
may be used. In this case, in the processing of S412 in 
5 Fig. 14, determining the body horizontal acceleration and 
the body posture angular acceleration such that a value 
obtained by subtracting the error Merr_p' (k) from the 
desired value of a floor reaction force moment horizontal 
component about the point of action (the desired value that 

10 causes the floor reaction force moment horizontal component 
about the desired ZMP to become zero) is produced will be 
equivalent to determining the body horizontal acceleration 
and the body posture angular acceleration (eventually 
determining the instantaneous value of a motion of a 

15 desired gait) such that -Merr_p(k) is produced about the 
desired ZMP. 

Further, the explanation has been given, taking 
the case where running of the robot 1 is performed as an 
example in the embodiment described above; however, the 

20 present invention can be applied also to a case where 

walking of the robot. 1 is performed. In this case, the 
floor reaction force vertical component trajectory (or a 
parameter defining it) may be set as shown in, for example, 
Fig. 40 in the aforesaid publication document 1. The body 

25 inclination angle restoring period may be set to, for 

example, the two-leg supporting period. Alternatively, if 
the friction coefficient of a floor assumed in generating a 
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gait is large and the floor reaction force horizontal 
component permissible range is sufficiently wide over the 
whole period of one step of the gait (if a translational 
floor reaction force horizontal component produced by a 
5 motion of the gait to be generated will securely fall 
within the floor reaction force horizontal component 
permissible range) , then the whole period may be set to the 
body inclination angle restoring period. Incidentally, in 
this case, a body inclination restoring moment ZMP- 

10 converted value may be zero. 

Further, in the aforesaid embodiment, the floor 
reaction force moment error Merr_p(k) has been used. The 
value obtained by dividing the Merr_p(k) by a desired floor 
reaction force vertical component at each time k of a gait 

15 will correspond to the amount of deviation (error) of the 
ZMP at time k (the point on a floor surface at which the 
moment horizontal component of the resultant force of the 
inertial force produced by a motion of a gait of the robot 
1 and the gravity becomes zero) from a desired ZMP. Hence, 

20 the error of a ZMP from a desired ZMP (this is denoted by 
ZMPerr_p(k) here) may be used in place of the floor 
reaction force moment error Merr_p(k). In this case, in 
the processing of S412 in Fig. 14, determining the body 
horizontal acceleration and the body posture angular 

25 acceleration such that the horizontal component of a floor 
reaction force moment acting, due to the resultant force of 
the inertial force produced by a motion of a gait of the 
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robot 1 and the gravity, about a point shifted in the 
opposite direction from a desired ZMP by the error 
ZMPerr_p(k) (the value obtained by converting Merr_p(k) 
into the amount of deviation of a ZMP from a desired ZMP) 
5 or by a value obtained by multiplying the error ZMPerr_p(k) 
by a predetermined coefficient (e.g., a positive number of 
1 or less) (the point whose position has been shifted from 
the desired ZMP by -ZMPerr_p(k) or the point whose position 
has been shifted by the value resulting from multiplying - 

10 ZMPerrjp(k) by a predetermined coefficient) becomes zero 
will be equivalent to determining the body horizontal 
acceleration and the body posture angular acceleration 
(eventually determining an instantaneous value of a motion 
of a desired gait) such that -Merr_p(k) or a floor reaction 

15 force moment horizontal component obtained by multiplying - 
Merr_p(k) by a predetermined coefficient is produced about 
the desired ZMP. This is equivalent to determining the 
body horizontal acceleration and the body posture angular 
acceleration (eventually determining an instantaneous value 

20 of a motion of a desired gait) such that the result 

obtained by adding ZMPerr_p(k) or the value obtained by 
multiplying ZMPerr_p(k) by a predetermined coefficient to 
the position of ZMP calculated on the simplified model from 
a motion of the gait to be created agrees with the position 

25 of a desired ZMP. 

Using the error ZMPerr_p(k) in place of Merr_p(k) 
in the aforesaid embodiment constitutes the embodiments of 
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the third invention or the fourth invention described above. 
In this case, to be more specific, in the processing of 
S306 in Fig. 13 or S806 in Fig. 18, Merr(k) determined in 
S418 in Fig. 14 may be divided by an instantaneous value of 
5 a floor reaction force vertical component at the 

appropriate time k and the result may be determined as the 
error ZMPerr_p(k). At this time, in S414 of Fig. 14, if 
the floor reaction force moment Msmpl(k) produced about the 
desired ZMP on the simplified model is calculated by actual 

10 computing of the simplified model, then the error 

ZMPerr_p(k) determined as described above means the 
difference between the ZMP calculated on a semi-full model 
from a motion (a provisional motion) of a gait that is 
being created by the processing of S306 in Fig. 13 or S806 

15 in Fig. 18 and the ZMP calculated on the simplified model 
from the motion. Hence, the embodiment in this case 
corresponds to an embodiment of the aforesaid third 
invention . 

Further, in S414 of Fig. 14, if the floor reaction 
20 force moment Msmpl(k) generated about a desired ZMP on the 
simplified model is calculated as the difference between a 
desired value (=0) of a floor reaction force moment 
horizontal component about the desired ZMP according to the 
aforesaid expression 3a and Merr_p(k), then the error 
25 ZMPerr_p(k) determined as described above means the 

difference between a ZMP calculated on a semi-full model 
from a motion (a provisional motion) of a gait that is 
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being created by the processing of S306 in Fig, 13 or S806 
in Fig. 18 and the desired ZMP. Hence, the embodiment in 
this case corresponds to an embodiment of the aforesaid 
fourth invention. 
5 Using the error ZMPerr_p(k) in place of Merr_p(k) 

in the aforesaid embodiment constitutes the embodiment of 
the third invention or the fourth invention described above. 
However, when generating a gait having a floating period, a 
floor reaction force vertical component becomes zero with a 

10 resultant unstable ZMP in the floating period; therefore, 
it is preferred to use a floor reaction force moment error 
as in the aforesaid embodiments. When generating a walking 
gait of the robot 1, no floating period will be included, 
so that ZMPerr_p(k) can be used throughout the period of 

15 the gait. Further, in these embodiments also, in place of 
the floor reaction force moment horizontal component error 
Merr(t) and the translational floor reaction force 
horizontal component error Ferr(t), floor reaction force 
correction amounts determined on the basis of their values 

20 may be used, as explained in relation to the modification 
of the first invention or the second invention described 
above . 

Further, in the aforesaid embodiments, the 
processing in Fig. 13 or Fig. 18 generates gaits that 
25 satisfy a desired ZMP and a floor reaction force horizontal 
component permissible range from the start to the end 
thereof, and then generates a gait (a normal gait or a 
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current time's gait), to which corrections of the floor 
reaction force moment error Merr_j?(k) and the translational 
floor reaction force Ferr_p(k) have been added, from the 
start to the end thereof; alternatively, however, the 
5 generation of an instantaneous value of a gait that 
satisfies a desired ZMP and a floor reaction force 
horizontal component permissible range and the generation 
of an instantaneous value of a gait to which corrections of 
the floor reaction force moment error Merr_p(k) and the 

10 translational floor reaction force Ferr_p(k) determined on 
the basis of a motion (provisional motion) of the gait have 
been added may be sequentially performed at each time k 
from the start to the end of the gait. 

Further, as previously described, the aforesaid 

15 semi-full model may be the same as a full model for full- 
model correction. In this case, to promptly and 
efficiently implement the processing for determining a gait 
parameter in the exploratory manner (the processing of S024 
and S028 in Fig. 10), the floor reaction force horizontal 

20 component permissible range for a semi-full model is 

preferably set to be wider than the floor reaction force 
horizontal component permissible range for a full model. 

Further, in the aforesaid embodiments, only the 
permissible range of the translational floor reaction force 

25 horizontal component about a desired ZMP has been set, 

excluding the processing for correcting a gait by the full 
model; alternatively, however, the permissible range of a 



- 134 - 



floor reaction force moment vertical component about the 
desired ZMP may be also set in order to prevent the robot 1 
from spinning. In this case, regarding a floor reaction 
force moment error, an error of a floor reaction force 
5 moment vertical component may be also determined instead of 
determining only an error of a floor reaction force moment 
horizontal component on a motion of a gait created on the 
simplified model such that the desired ZMP, the floor 
reaction force horizontal component permissible range, and 

10 the permissible range of a floor reaction force moment 

vertical component are satisfied, and then a motion of a 
desired gait may be generated such that the moment composed 
of a floor reaction force moment vertical component 
produced on the simplified model and an error relative to 

15 the vertical component satisfies the permissible range for 
the vertical component. 

Further, in the processing of S306 in Fig. 13 or 
S806 in Fig. 18, an error of a translat ional floor reaction 
force vertical component may be also determined, and then a 

20 motion of a desired gait may be generated such that the 
value composed of a translat ional floor reaction force 
vertical component produced on the simplified model and an 
error thereof satisfies a desired value of the 
translational floor reaction force vertical component. 

25 Industrial Applicability 

As is obvious from the above explanation, the gait 
producing device for a moving robot in accordance with the 
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present invention is useful in that it is capable of 
efficiently generating a gait that makes it possible to 
prevent the robot from slipping and to successfully secure 
dynamic accuracy between a motion of the gait and a floor 
5 reaction force while accomplishing temporal coordination 
between them at the same time, and also capable of 
generating a gait of a moving robot, such as a biped moving 
robot in particular, which inherently has low stability, 
while securing the stability of the moving robot. 
10 Brief Description of the Drawings 

Fig. 1 is a diagram showing the overview of the 
entire construction of a moving robot (a bipedal walking 
robot) to which the embodiments of the present invention 
are applied. 

15 Fig. 2 is a side view showing the construction of 

a foot portion of each leg body of the robot shown in Fig. 
1. 

Fig. 3 is a block diagram showing the construction 
of a control unit provided in the robot shown in Fig. 1. 
20 Fig. 4 is a block diagram showing the functional 

construction of the control unit shown in Fig. 3. 

Fig. 5 is a block diagram showing the functions of 
a gait generating device shown in Fig. 4. 

Figs. 6(a) and (b) are diagrams for explaining the 
25 motion modes (a body translat ional mode and a body rotation 
mode), respectively, of the robot. 

Fig. 7 is a diagram showing the structure of a 



- 136 - 



first dynamic model (a simplified model) used for 
generating gaits. 

Fig. 8 is a diagram showing the structure of a 
second dynamic model (a semi-full model) used for 
5 generating gaits. 

Fig. 9 is a diagram showing the structure of a 
full model used for generating gaits. 

Fig. 10 is a flowchart showing the main routine 
processing of the gait generating device in an embodiment. 
10 Fig. 11 is a flowchart showing the subroutine 

processing of Fig. 10. 

Fig. 12 is a flowchart showing the subroutine 
processing of Fig. 10. 

Fig. 13 is a flowchart showing the subroutine 
15 processing of Fig. 12. 

Fig. 14 is a flowchart showing the subroutine 
processing of Fig. 13. 

Fig. 15 is a flowchart showing the subroutine 
processing of Fig. 14. 
20 Fig. 16 is a flowchart showing the subroutine 

processing of Fig. 10. 

Fig. 17 is a flowchart showing the subroutine 
processing of Fig. 10. 

Fig. 18 is a flowchart showing the subroutine 
25 processing of Fig. 17. 

Fig. 19 is a graph showing examples of body 
inclination restoring moment ZMP-converted values in a 



normal gait. 

Fig. 20 is a graph showing examples of body 
inclination restoring moment ZMP-converted values in a 
current time's gait. 

Fig. 21 is a graph showing examples of a 
provisional desired ZMP, a ZMP correction amount, and 
desired ZMP in a current time's gait. 



